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FOREWORD 


This document presents the results of work performed 
by the Martin Marietta Corporation while under contract 
to NASA L. B. Johnson Space Center. This final report 
was prepared as partial fulfillment of Contract NAS 9- 13027,, 
Attached Manipulator System Design and Concept Verification 
for Zero-G Simulation. The NASA Technical Monitor for the 
contract was Mr. Richard B. Davidson, of the Spacecraft 
Design Division, Engineering Technology Branch. 
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I. INTRODUCTION AND SUMMARY 


The goal of the Attached Manipulator System (AMS) program 
is the development of Shuttle related long-boom teleoperator 
technology. The purpose of the AMS is to simulate and demon- 
strate zero-g Shuttle manipulator cargo handling operations. 

It is not the design or development of the Shuttle Attached 
Manipulator System (SAMS); however, every effort is being 
made, to insure that the AMS will be functionally similar to 
the SAMS. 

The objective of this contract is the investigation of 
the primary AMS technology questions, verification of AMS 
design concepts, and the preliminary design of critical com- 
ponents. The technology questions examined in this effort are 
those shown in Figure 1-1. All technology questions have been 
answered satisfactorily and design concepts have been success- 
fully verified. Preliminary designs of all critical compon- 
ents have been completed, which meet all functional and con- 
figurational requirements . 

Martin Marietta is confident that the AMS is technically 
feasible and that a detail design and fabrication program can 
now be successfully undertaken. 

Chapter II, Design Requirements, enumerates the config- 
urational and functional requirements of the AMS and its sub- 
systems. The overall AMS manipulator design is discussed and 
a typical simulation layout is shown. An analysis was made of 
the Shuttle manipulator movement requirements using an eighth 
scale Shuttle and 50 ft (scaled) manipulator model. Seven 
satellite capture trajectories were evaluated, along with var- 
ious cargo placement and satellite servicing tasks. A scaled 
40-ft long x 15- ft diameter payload mockup was used for cargo 
handling tasks. Both 6 and 7 degree of freedom (DOF) manipu- 
lator configurations were evaluated. Each joint angle was 
continuously monitored and recorded throughout each operation- 
al trajectory. Manipulator tip position and terminal device 
attitude, in relation to the manipulator shoulder, were com- 
puted for each trajectory. The results of the analysis were 
used to select tasks for further evaluation using our 6 DOF 
simulator (SOS). Position controller movements were related 
to the manipulator trajectories. 




Figure 1-1 AMS Technology Questions 



Chapter XXX, Control System’ Breadboard, describes a new 
manipulator control technique.. The control scheme permits a 
bilateral system with great master-slave size disparity to 
incorporate coordinate transformations, variable gain ratios, 
and position indexing between input controller and output 
manipulator. The translational control law equations are 
derived, and the servo system design procedures using both 
frequency and time domain techniques are presented, A two 
DOF master-slave breadboard, was .designed., built, and tested. 

The breadboard verified the control technique to be feasible, 
and the hardware test results were- used to document (1) bi- 
lateral operation, (2) coordinate transformations, (3) vari- 
able gain ratios, (4) position indexing, and (5) stability. 

The coordinate transformations, variable gain ratios, and 
position indexing operated satisfactorily, and the force 
reflecting ratio was shown to be truly independent of these 
features. The master and slave, tip to tip tracking properties 
were excellent, and it was demonstrated how man- in- the- loop 
serves as an adaptive filter for. stabilizing a bilateral 
system handling a large - payload. The , unloaded manipulator 
bandwidth varied from 3. 0 Hz to 1. 6 Hz. as the variable gain 
ratio was raised from MM - 1/2 to MM == 1/8. The loaded mani- 
pulator (306 lbs air bearing load at the manipulator tip) 
bandwidths for these same variable gain ratios varied from 
0. 2 to 0. 1 Hz, The sampled analog system revealed the toler- 
able sample rate to range from 10 msec for MM =?, 1/2 to 32 
msec for MM = 1/8. A simple unilateral-bilateral comparison 
of a maze task indicated the bilateral mode to be two to seven 
times more efficient for the particular tests conducted. 

In Chapter IV we discuss the manipulator joints, counter- 
balance, and overall manipulator design. Two gear train con- 
cepts were designed and breadboarded full scale. Comprehensive 
tests- were conducted with these and with a purchased harmonic 
drive. Results showed an .internal (ring) gear with double 
drives to be superior in torsional stiffness, efficiency, and 
compactness of size. ; s ; •• 

A gear train ratio/motor size selection scheme is develop- 
ed which is used to preliminarily design the manipulator 
shoulder pitch joint and elbow joint. In addition, the pre- 
liminary design of the shoulder roll drive is discussed. 

A counterbalance optimization technique is developed and 
is used to arrive at a counterbalance design incorporating a 
2900 lb counterweight as one resulting in the least increase 


1-3 



in moment of inertia while satisfying certain design constraints. 
A near full-scale breadboard of the counterbalance linkage is 
described and test results presented. This linkage concept was 
selected from many alternatives and the selection rational is 
tabulated. 

Lastly, this chapter presents the design layout of the 
AMS manipulator and shows a 15 % scale model which proves the 
articulated counterbalance principle. 

Chapter V, Control Devices, describes our evaluation of 
position control devices. This evaluation followed an orderly, 
systematic approach, consisting of four phases: requirements 

development, design evaluations, dynamic simulations and a 
recommended final design. Primary emphasis was placed on 
the development of a 6 DOF position controller that could be 
indexed and have variable movement ratios between the control- 
ler and the manipulator. Both unilateral and bilateral pos- 
ition controllers were evaluated, as well as two 3 DOF Apollo- 
type rate controllers. MMC’s 6 DOF Space Operations Simulator 
was used for dynamic tracking and capture, and cargo handling 
task evaluations. The recommended controller configuration 
is a 6 DOF, floor mounted unit, which has a pitch and yaw 
shoulder and a vertical telescoping section. It has a 3 DOF 
attitude balanced, gimbal arrangement at the wrist. The con- 
troller evaluation criteria was based primarily on human fac- 
tors and mechanical design considerations. The evaluation did 
not compare computational requirements of the candidate con- 
troller configurations. A full-scale model of the telescoping 
controller was fabricated. 

Chapter VI contains a detailed account of the dynamical 
analyses of the AMS, Three parallel efforts are described. 

First, the mathematical model and corresponding computer pro- 
gram describing the rigid body behavior of the SAMS and the 
AMS is presented. This program was used to compare the per- 
formance of the AMS with that of the SAMS for identical pay- 
load handling tasks. The results are used to arrive at AMS 
joint torque requirements of 1200, 650, and 300 ft-lbs for 
the shoulder, elbow, and wrist joints, respectively. The 
differences in performance between the SAMS and the AMS are 
also discussed. 

Next, two types of AMS vibration analyses are presented. 
Using preliminary design data, the frequencies and mode shapes 
of the counterbalanced and non- counterbalanced versions of the 
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AMS are compared. The results predict fundamental frequencies 
on the order of 1 Hz for the unloaded AMS and .02-. 03 Hz for 
the loaded manipulator (60,000 lb payload). 

Finally, using an existing Martin Marietta computer 
program, the nonlinear (large joint excursions) flexible 
behavior of the AMS is studied. Results comparing rigid and 
flexible AMS motions for a simplified payload handling task 
indicate oscillations (about the rigid body trajectory) with 
approximately a 3 in. amplitude (peak-to-peak) and a frequency 
of .05 Hz. 

This final report describes all work done under Contract 
NAS9-13027. This report includes all of the material from 
the Final Report Briefing, with the exception of some charts 
prepared as part of company -funded research task. 


The 

arately 


design drawings and associated lists are bound sep- 
from this report. 
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II. DESIGN REQUIREMENTS 


A. CHARACTERISTICS AND SYSTEM DESCRIPTION 
1- Requirements 

The intended use of the AMS in a zero-gravity simulation 
facility is for dynamic response testing and for demonstration 
of the capability to deploy payloads, retrieve and stow orbit- 
ing payloads, and service satellites. 

The AMS design requirements include both configuration and 
functional requirements. The former include: (1) 40- ft total 
arm length, (2) upper and lower arm segments of 18.5 ft each, 

(3) aluminum tubes 12 in. outside diameter, (4) seven degrees 
of freedom plus terminal device, (5) shoulder: pitch, yaw and 
roll; elbow: yaw; wrist: yaw, pitch and roll, (6) joint tor- 

que and travel characteristics (Table II-l), (7) counterbalanced 
to overcome gravitational effect on joints, and (8) 6 degrees 
of freedom position controller. 

The functional requirements include: (1) operation un- 

loaded in any plane, (2) operation loaded in horizontal plane, 

(3) reach capability governed only by the joint angular travel, 

(4) fail-safe joint brakes, (5) 5 minute deployment time (65,000 
lbs), (6) 2-ft stopping distance, loaded (65,000 lbs), (7) 0.2 
ft stopping distance, unloaded, (8) 2 ft/sec unloaded tip veloc- 
ity* (9) 0.2 ft/sec loaded (65,000 lbs) tip velocity, (10) 30 
lbs static tip force (tangential with arm extended), (11) bi- 
laterial, force reflecting control system with indexing, sel- 
ectable coordinate system, and variable control ratios, (12) 4 
in. static tip deflection due to motor loading; 4 in. due to 
gravity and, (13) backdr iveable joints. 


TABLE II- 1 JOINT DESIGN CHARACTERISTICS 


Angular Travel 
(deg) 

Pitch 

Yaw 

Roll 

Yaw 

Yaw 

Pitch 

Roll 

+ 200 

+ 150 

+ 200 

2 

+ 164 

+ 120 

± 120 

+ 200 

Stall Torque 
(ft-lb) 

1200 

1200 

650 

650 

300 

300 

200 


II-l 
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Manipulator Design 


Figure II- 1 is the AMS with articulated counterbalance. 

The design incorporates a wide yoke at the shoulder yaw joint. 
This provides a balanced 40 “ft manipulator whose shoulder or 
elbow joint torques need not, in any orientation, overcome the 
force of gravity on either the upper or lower arm and whose 
motion is completely unrestricted either loaded or unloaded. 
This design produces an AMS whose moment of inertia (unloaded) 
about the shoulder is increased a maximum of only 307 o due to 
the counterbalance mass. In the loaded case (65,000) the in- 
crease is only a fraction of a percent. Therefore, the dynamic 
operating characteristics have been only slightly altered from 
the uncounterbalanced (zero-g) arm. 

The tip deflections for an upper and lower arm tube wall 
thickness of 0.18 in. and 0.08 in., respectively, are given in 
Table II-2. These numbers are based on joint stiffness as 
determined from geartrain tests . 

Table II-2 Static Deflections 



Loading 

Component 

Torque Motor 
(Stall) 

Gravity 

Total 

Beams 

1.05 in. 

3.31 in. 

4.36 i n. 

Joints 

2.70 in. 

0 

2.70 in. 

Total 

3.75 in. 

3.31 in. 

7.06 in. 


Maximum Horizontal Deflection 
Maximum Vertical Deflection with no Vertical Torque Force- 
Maximum Vertical Deflection with Torque Force Up ■ 



3. Simulator Layout 

Figure 11-2 shows a simulator concept for payload deploy- 
ment, and stowage. It is based on an airbearing facility with 
an operator f s console and test director f s console. It is this 
AMS simulation configuration that produces the terminology for 
the degrees of freedom for the manipulator, since with the 
Shuttle as reference, the shoulder first joint becomes a pitch 
drive, the elbow a yaw and so forth. 
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Figure II- 1 AMS With Articulated Counterbalance 
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t, Payload Deployment 


B. MANIPULATOR TRAJECTORY DEFINITION 


The purpose of this analysis was to determine desirable 
Shuttle manipulator movement trajectories and manipulator 
characteristics when related to typical payload tasks. This 
data was required to establish design requirements for the 
manipulator, operational limitations for this configuration and 
establish operational requirements for the position controller. 
Initially the maximum joint angular travel limits for each 
joint was derived from the data analytically established in 
a prior contract*. These joint characteristics were incor- 
porated into a scaled 50 -ft manipulator (which was the shuttle 
baseline length) to allow evaluation through various operational 
trajectories. The following manipulator tasks were simulated. 

(1) Seven Capture Trajectories, 

(2) Cargo Placement, 

(3) Cargo Deployment, 

(4) Cargo Bay Reach Envelopes, 

(5) Docked Satellite Reach Envelope , and 

(6) Module Replacement. 


To date, much of the manipulator movement data has been 
derived from simple desk-top models or by computer analysis. 

The desk-top models show gross movements but lack accuracy. 

They also have no way of recording joint movements and tip 
trajectories. Computer analysis are generally limited to 
point to point translations and do not account for Shuttle obstacles 
such as cargo bay doors, the docking port and flight deck. 

An eighth scale mockup of the Shuttle was used since it was 
lerge enough to allow high fidelity and small enough not to be 
cumbersome. The total mockup was approximately 10 ft long. 

(Figure II- 3) # The Shuttle and cargo mockups were constructed 
of foam-core and plywood. The manipulator was made of aluminum 
and steel. Each joint has potentiometers to Measure the joint 
angles and a friction brake for locking in position. The 
manipulator is scaled for 50 ft from the shoulder centerline 
to the center point of the terminal device and has seven degrees 
of freedom. The joint ordering, starting at the shoulder, is 
pitch, yaw, roll with yaw at the elbow and yaw* pitch, roll 
at the wrist. (See Figure II-4) 

Continuous joint angle data was taken during each run on a 
standard 8 channel Brush recorder. Joint angle data was not 
taken while reach envelopes were being evolved, since the reach 
limits themselves were the desired results. The r^w strip chart 

* NAS 9- 11932 "Preliminary Design of a Shuttle Docking and Cargo 
Handling System" 
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Figure II- 3 One-Eighth Scale Shuttle and Manipulator Mockup 





data was digitized and computer printouts were made showing all 
seven joint angles throughout each run with the corresponding 
terminal device positions, which were computed for the X, Y, Z 
Shuttle coordinates (based at the shoulder). Gross manipulator 
positions were noted beside the data, such as initial condition 
(I.C. ) , forward capture position, rear capture position, etc. 

1. Capture Trajectories 

Seven basic capture trajectories were analyzed (See Figures 
IX- 5 to 11-15. At the time of the study, the baseline for 
satellite capture was a flyby technique where the Shuttle was 
flown to within a capture envelope, then deactivate the Shuttle 
attitude control system**, reached out and attach the manipulator 
to the satellite. The satellite was to be attitude stabilized 
and have a relative velocity no greater than .25 ft/ sec . This 
capture philosophy dictated capture paths for the satellite 
relative to the Shuttle. The intent of the analysis was to 
determine which one looked best from the manipulator movement 
standpoint. Twenty-five feet was selected for the minimum 
distance between the Shuttle and a passing satellite. Through- 
out all the trajectory evaluations the manipulator elbow joint 
was bent away from the Shuttle structure. The maximum path 
length was established by accurately placing an aluminum angle 
the length of the proposed trajectory and positioning the mani- 
pulator to each extreme. This was derived by extending the 
manipulator until the elbow was within 10 of being straight 
out. The operational path length is 75% of the maximum travel. 
This means, primarily, that if you do not have the payload 
stopped by the limit of the operational travel (reach), it should 
be released. 

Each capture trajectory was evaluated with the manipulator 
configured for a full 7 -DOF and also with the shoulder roll 
locked at 0 for 6-DOF. All capture task manipulator maneuvers, 
started from the I.C, condition shown in Figure II-4 then were 
extended to the forward maximum reach and then maneuvered along 
the guide to the rear position. 

Capture Concept 1 - Down Shuttle Centerline - This concept 
would be relatively easy for the pilot to do the initial align- 
ment. However, the satellite is on a collision course with 
the tail. See Figure II-5 and .11-6... The trajectory is directly 
over the operator’s windows for good direct vision. The maximum 
reach* is quite long - 80 ft. The post capture stowage maneuver 
is very short since the satellite is directly over the cargo bay 

* "reach 11 is used here to denote the length of the path. 

** Main (large) thruster system. 
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Figure II-5 Capture Concept 1 - Dovn Shuttle Centerline 
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Figure II- 6 Capture Concept 1 - Down Shuttle Centerline 



when the relative velocity between Shuttle and payload is stopped. 

Capture Concept 2 - Over the Wins - The satellite trajec- 
tory in this concept is from nose to tail, over the wing (Figure 
II- 7 and II-8. This concept also allows the Shuttle pilot good 
visibility for initial alignment. The trajectory is not on a 
collision course with the Shuttle. The maximum reach, 84 ft, 
was the longest of all of the concepts evaluated. The manipulator 
operator could have good direct vision, depending on the Shuttle 
window configuration. The manipulator elbow required 150° of 
travel in the negative (yaw) direction. 

Capture Concept 3 - Vertical Over Shoulder Centerline - This 
concept relates to the Z docking maneuver, which was not well- 
defined at the time. As can be seen in Figure II- 9, this concept 
limits the maximum reach to 40 ft, which is the shortest of all 
the trajectories evaluated. Because of the combination of a 
26 ft operational reach limit and the direct collision course 
with the Shuttle, this concept is considered very poor when com- 
pared to the others. The downward reach is limited by the mani- 
pulators elbow to bend back on itself. In this case, the limit 
was 150°. This is shown in Figure 11-10. 

Capture Concept 4 - Across Cargo Bay - This concept (Figure 
II- 11 and 11-12) allows excellent direct vision to the manipulator 
operator if the docking module is not installed in the cargo bay. 
The trajectory is across the cargo bay in the Shuttle Y Axis. 
Maximum reach is average, (65 ft) and no gross manipulator angu- 
lar motions were required. 

Capture Concept 5 - Across Manipulator Shoulder - This con- 
cept (Figure 11-13) provides good direct vision potential for the 
manipulator operator, good maximum reach and non-collision course. 
The trajectory is poor from the Shuttle pilot* s standpoint, 

Initial alignment might be difficult^ With the capture path 
25 ft above the Shuttle skin and the manipulator segment lengths 
used, the elbow moves into the capture path as the terminal 
device passed through the Shuttle centerline. By moving the 
capture path up 5 ft (to 30 ft) this is avoided. 

Capture Concepts 6 and 7 - Across Pilot’s Station - Concepts 
6 and 7 (Figures 11-14 and 11-15) are nearly the same except 
trajectory 7 is 8 ft lower in the Z-axis than 6. These con- 
cepts were evaluated to show capture trajectories which would 
be adequately far from the Shuttle vehicle to allow a 60 ft 
payload to slowly rotate about its eg, after capture, and not 
collide with the Shuttle. Both concepts place the terminal 
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Figure II-8 Capture Concept 2 - Over the Wing 



Reach = 40 Ft 



Figure II- 9- Capture Concept 3 - Vertical Over Shoulder Centerline 



Figure II- 10 Capture Concept 3 - Vertical Over Shoulder Centerline 
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Figure 11-11 Capture Concept 4 - Across Cargo Bay 
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Figure 11-13 Capture Concept 5 - Across Manipulator Shoulder 




Figure 11-14 Capture Concept 6 - Across Pilot Station 



Reach 
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Figure 11-15 Capture Concept 7 - Across .Pilot Station 


device in front of the Shuttle nose. Both 6 and 7 allow excellent 
Shuttle pilot direct vision (especially 7) but none for the 
manipulator operator. The post capture maneuvers are signifi- 
cant. A translation of 45 ft in the X-direc tion alone would 
require additional time for a 60K payload. 

2. Cargo Placement 

A cargo placement evaluation was made for each capture con- 
cept. The cargo mockup was scaled for a 15- ft diameter by 40- ft 
long satellite. The starting point for each placement was the 
end of the operational reach for each capture trajectory. This 
point was carefully determined for each trajectory, the 
terminal device was attached to the cargo mockup and the mockup 
was slowly maneuvered into the cargo bay. Joint angles were 
recorded and all of the maneuvers required no more than 6 -DOF 
in the manipulator. 

3. Cargo Deployment 

The cargo deployment task consists of: 

(1) Maneuver the manipulator to the upper center of the 40 ft 
satellite mockup, in the cargo bay, 

(2) Attach the terminal device to the center of the mockup 
(Figure 11-16), 

(3) Maneuver satellite straight up to clear cargo bay by 
approximately 10 ft, 

(4) Roll satellite 180°, 

(5) Extend manipulator straight up, in Shuttle Z axis, to 
operational limit, and 

(6) Release satellite. 

Joint angles were recorded for this maneuver and 7 -DOF 
(roll at the shoulder) was not required. 

4. Capture and Cargo Placement 

a. None of the capture concepts, placement or deployment 
of the large cargo requires the 7th-D0F (roll at the 
shoulder) (a 7 -DOF requirement is discussed in Section C) . 
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Figure 11-16 Cargo Deployment 




b. Having roll at the shoulder did not increase the capture 
trajectory reach envelopes. 

c. At no time during these manipulator maneuvers did the 
elbow rotate to the positive direction. The elbow 
was only required to bend as a human arm does. 

d. Capture concept 2, over the wing, was selected as the 
most desirable of the 7 evaluated. It gave the 
longest reach, and provided good direct vision poten- 
tial for both the pilot and the manipulator operator. 

No gross translations were required after satellite 
capture, since the deceleration zone is nearly over 
the cargo bay. The satellite is not on a collision 
course with any part of the Shuttle vehicle. This 
concept was used for dynamic capture task evaluations 
on our Space Operations Simulator* 

e. Maximum joint angular travel requirements are shown 
in Figure 11-17. 

f. Joint angle travel profiles and associated tip position 
data are contained in Appendix E # 

C. MANIPULATOR REACH CAPABILITIES 

“For the 6 and 7 -DOF manipulator, reach zones in the cargo 
bay were determined. The manipulator was scaled for 50 ft 
long and 12 inches in diameter. Four levels in the cargo bay 
were evaluated. These all related to the cargo bay door hinge 
line. The top level was 3 ft above the hinge line. Level 2 
was at the hinge line. Levels 3 and 4 were 3 ft and 6 ft below 
the hinge line, respectively. The task was to establish a zone 
on each level where the terminal device could reach straight 
down, touch the level and maneuver straight up as though it. 
were attached to cargo. It quickly became obvious that roll 
at the shoulder was required. 

First, all levels were evaluated with a 6 -DOF manipulator, 
with the shoulder roll locked at 0 . As can be seen in Figures II- 18a 
thru c on level 1 and 2 and the reach zones are somewhat the 
same and appear operationally adequate. On levels 3 and 4 how- 
ever, the reach zone is limited by the outer segment of the 
manipulator arm hitting the hinge line as greater shoulder pitch 
is required to move the terminal device down into the cargo bay. 

The reach limits were derived by allowing the lower arm to come 
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Figure 11-17 Maximum Joint Movements for 7 Capture Concepts (6-DOF Slave) 
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Figure IX- 18b Manipulator Reach Zones 
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Figure II- 18c Manipulator Reach Zones 


down to within one foot (scaled) of the hinge line. As shown, in 
Figure II- 18c levels 3 and 4, with 6-DOF and shoulder roll at 0°, 
the task of reaching below the hinge line rapidly deter iates , 
until on level 4, the contact zone becomes a small triangle 
at the rear of the reach zone. This appears unacceptable. 

Next, using a full 7 -DOF , the shoulder roll angle was 
carefully recorded to determine its travel. Obviously, the 
full 7 -DOF gave the greatest movement volume since the elbow 
was free to be positioned straight o up. During the tests, the 
shoulder roll f luxuated between 28 and 64 while the tip of 
the slave was moved around the cargo bay. Since reaching 
into the cargo bay was the only requirement for the 7th-D0F, 
it was concluded that it may be possible to have two discrete 
positions for the shoulder roll, and perhaps have a more 
simplified roll joint^ontrol^ The roll joint was set in 10 
increments between 25 and 65 and reach zones were again 
evaluated. The data showed that at about 45 the best compro- 
mise was obtained, if a single roll angle (in addition to zero) 
was to be selected. With this concept the manipulator operator 
would control the shoulder roll with a switch to select 0 or 
45 as the task required. The reach profiles are also shown 
for the shoulder roll at 45 in Figures II-18B& C. 

1. Docked Satellite Reach Envelopes 

This task was to determine the reach zones on the surface 
of a 15 -ft diameter by 40 -ft long satellite, docked to the Z 
axis docking port. This data relates to satellite maintenance, 
and where the manipulator can reach to do a useful task. The 
reach zones represent not only the terminal device touching the 
area, with the wrist roll axis orthogonal to the payload surface, 
but also being able to move away orthogonally for 5 ft. This 
would represent pulling a module out. Figure II-19ashows the 
areas reachable (shaded) in a plan view of the cylinder outer 
skin. Three reach envelopes are shown for the manipulator con- 
figured in 6-DOF (shoulder roll at 0°), 6-DOF (shoulder roll 
at 45°) and a full 7-DOF. Figure II-19b shows the overlapping 
zones when two symmetrically mounted manipulators are used. 

The zone limits were established by either the manipulator upper 
arm hitting the mockup or by joint limits being reached. 

2_ . Module Replacement 


The module replacement task consisted of reaching to the 
center of the cargo bay, at the hinge line, attaching the terminal 
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Figure II- 19a Docked Satellite Reach Envelopes 
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Figure II-19b Docked Satellite Reach Envelopes fCwo Manipulators) 




device to a module mockup, lifting the module straight up, 
rotating 90° and inserting it into the satellite mockup 
(See Figure 11-20). This task was easily done with a 6-D0F 
(shoulder roll at 0°) manipulator configuration. 
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Figure 11-20 Module Re 


III. SERVO DESIGN OF A 2 -DEGREE OF FREEDOM X REFERENCE FRAME 

BILATERAL FORCE REFLECTING POSIT ION -POSIT ION CONTROL SYSTEM 

A. CONTROL LAW EQUATIONS 

1. Objective 

The objective of this section is the control law design 
of a 2-DOF bilateral force reflecting control system for use in 
a manipulator system breadboard incorporating a 2-DOF master 
and a 2-DOF slave. 

The 2-DOF breadboard control system is for concept verifi- 
cation prior to the detail design of a 6-DOF control system for 
the AMS. 

The control system must include the following features: 

1. Bilateral force reflecting operation, 

2. Size disparity between master and slave, 

3. Different coordinate systems for master and for slave, 

4. Position indexing for the master, and 

5. Variable control gain ratios between master and slave. 

2. Existing Bilateral Manipulator 

To develop an understanding and appreciation of the control 
scheme being designed, a brief discussion will be given here of 
the control principles of existing bilateral manipulators and 
why these principles cannot be directly applied to a manipulator 
possessing the aforementioned capabilities. 

Bilateral force reflecting manipulators, incorporating a 
geometrically similar master controller as the control input 
device, possess, in addition to the forward position loop 
which makes the manipulator follow the master movements, feed- 
back to the master from the manipulator. The servo parameter 
used for this feedback may be either position or force. Figure 
III-l depicts this two way information flow between master and 
slave. To be more explicit, Figure III-l can be shown in 
greater detail. Figure III-2, to reveal that existing bilateral 
manipulator systems with roaster replica controllers have two 
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Figure III-l Two Way Information Flow in Bilateral Force Reflecting Manipulator System 





Figure II I- 2 Bilateral Force Reflecting Manipulator With One to One Joint Coupling 








way information flow only on a one-to-one joint basis. That is, 
master and slave have the same number of degrees of freedom and 
each joint on the master is electrically coupled to and only 
to its counterpart joint on the manipulator* Thus, each master- 
slave joint pair track each other in angular positions at some 
prescribed ratio. 

To understand the inability of a one-to-one joint coupled 
system to perform multi-mode and coordinate indexed functions, 
consider the situation shown in Figure III-3. Represented is 
the master operating in Shuttle axis (axis system one) and the 
manipulator operating in its own terminal device TV camera 
axis (axis system two). If it is desired that the manipulator 
move forward in the direction, the master must be moved for- 
ward in the direction. It is easily seen that the ratio of 
movement between any joint on the master and its counterpart 
on the manipulator is a function of manipulator position. In 
fact, the situation could easily arise whereas all joints on the 
master are in motion and only one or two joints on the manipu- 
lator are activated to produce the commanded trajectory. Thus, 
one-to-one joint coupling is totally inapplicable for coordinate 
indexing. Likewise, for multi-mode operation (operation in which 
the tip position of the master and the tip position of the 
slave move with respect to each other in some set ratio, and 
this ratio can be selected by the operator) one-to-one joint 
coupling is impractical (considering now motion ratios other 
than 1:1, and large master-slave size disparity). This is 
easily seen if it is realized that the motion ratio for a 
master-slave joint pair is a function of position if the tip 
motion ratio between the input and output devices is to remain 
constant. ; 

In order to surmount the abovemen t ioned problems, the com- 
parison of individual joint positions in a one-to-one joint 
coupled system must be abandoned and a new quantity of compari- 
son devised. This new quantity is the XYZ (henceforth referred 
to as X) tip position of the master and manipulator. By doing 
all comparisons in the X reference frame, the capabilities of 
coordinate indexing, multi-mode operation, and position indexing 
are easily obtainable as will be shown below. 

3. Basic Control Scheme 

Figure III-4 shows the block diagram of the X reference 
frame position-position bilateral force reflecting control 
scheme under consideration. It was stated previously that the 
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feedback parameter for a bilateral manipulator system could be 
either position or force. As evidenced by Figure I 11-4, the 
parameter of position has been selected to illuminate the 
inherent problems associated with force measuring devices such 
as strain gauges. 

As seen from Figure III-4, the first step in the control 
laws is the calculation of the X tip position of the master and 
the X tip position of the manipulator. After these tip posi- 
tion values are obtained, they are operated on by coordinate 
transformation matrices, gain or attenuation functions (to 
obtain the proper multi-mode value) , and can readily be summed 
with bias voltages to provide position indexing. The resulting 
X 1 and X* values are compared to produce + X position error 
signals, ftiese signals are multiplied by appropriate gain 
matrices (the magnitude of these gain functions determine the 
compliance oy stiffness of the control system) and are then 

summed with X and X tip velocity terms which produce the 
— ~q — m *■ 

needed system damping. The resulting signals represent X tip 

forces that the master and slave must apply to their environment. 

These force signals are then operated on by torque distribution 

matrices with the result being the desired signal levels to 

be sent to the individual servo motors at each master and 

slave joint. 

Although this X reference frame control technique does 
provide a bilateral manipulator system with the desired perfor- 
mance qualities, it also introduces two system complications , 
these being: 

1. The resultant control system is highly nonlinear, and 

2. The master and slave must be interfaced with either an 
analog or digital computer. 

The effects of these two complications will be discussed 
further . 

4. Two DOF Control Laws 

a. Purpose of Two DOF Breadboard - Figure II 1-4 represents 
the translation X reference frame control logic for a bilateral 
force reflecting manipulator with coordinate indexing, multi- 
mode operation, and position indexing. For a six DOF manipu- 
lator, controlling the tip translations is only half the job, 
terminal device rotational control must likewise be considered. 
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It is conceived that rotational and translational control 
will be similar in that the terminal device orientation 
of both the master and slave will be computed with respect 
to some inertial orientation and then compared to 
produce a 0^ orientational error signal in much the same fashion 
that a X positional error signal is computed for translational 
control. The details of rotational control have not been con- 
sidered but it is believed that a slightly more complicated 
technique will be needed for rotational as compared to trans- 
lational control. Therefore, this initial investigation will 
deal primarily with the problems of translational control and 
hopefully the solutions to these problems will expedite the 
eventual design of the rotational part of the system. 

To "prove the concept", in hardware, of the translational 
control technique, a two, instead of three, DOF breadboard 
was selected. This decision was made for two reasons: (1) all 

the computer calculations needed for three DOF are also needed 
for two DOF, and therefore the simpler situation can prove the 
workability of both cases, and (2) a two DOF manipulator needs 
no counterbalancing mechanism and thus is quite cost effective. 

Figure III-5 shows the two DOF master and slave breadboard 
arms. The master has segment lengths of one foot with the 
manipulator segment lengths being two feet. The actual size of 
the arms was not critical but a master-slave size disparity was 
important to prove the validity of the control equations. As 
indicated by Figure III-4, the two arms shown will be interfaced 
by computer (analog first then digital) that, will perform the 
needed calculations. 

b. Shortcomings of Two DOF Breadboard - To fully under- 
stand what is to be expected from the design of the two DOF 
breadboard, the questions it will, not answer must be made cleaif; 

(1) Figure III- 5 shows there are no terminal devices on the end 
of either the master or slave, and therefore, as mentioned earlier, 
no rotational control . techniques are included, (2) One of the 
major unknowns of the full length AMS manipulator is the effect 
of low frequency structural oscillations that presumably can be 
excited in the manipulator beams. The two DOF breadboard is not 
designed to investigate this problem, for as seen in Figure III-5, 
the beam structures are relatively short and very r igidi v . ? In a 
separate section this problem is addressed by using the fes^ults 
of the breadboard design to write a computer program for the •> 
design of a full length two DOF manipulator which is integrated 
with another program describing the manipulator flexible body 
dynamics. These two combined programs are used to investigate 
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Figure III-5 Two DOF Master and Slave Breadboard Arms 














the effects of structural oscillations on the control system, 
and will, if necessary, aid in the design of an active damping 
system. 


c « Block Diagram of Two DOF Control System - 

Figure III-6 represents the block diagram of the control 
system for the two DOF breadboard. This diagram includes ail 
joint components (servo motors, tachometer generators, gears, 
potentiometers, etc.) of both the master and slave along with all 
the signal channelling and necessary computer accomplished 
computations. Double lined signal routes represent two separate 
signals, and many of the gain functions are actually gain 
matrices, as will be described below. A considerable number 
of the variable names are included only as an aid in computer 
programming and will not be defined, whereas the more important 
quantities are defined in Table III-l. Those elements that 
cannot be clearly explained by the use of Figure III-6 and 
Table III-l are briefly discussed in further detail below. 

1. XC 

XC is a two dimensional vector denoting the X and Y tip 
position of the master. This tip position is calculated from 
a knowledge of the master shoulder, X(l), and elbow, X(3), 
angular positions. From Figure III-7 it is seen that XC is 
calculated as follows: 


XC (2) 



Figure III-7 Joint Angles and Tip Position Labelling 
for Master 
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Table III-l Definition of Variable Names Appearing in Figure II1-6. 
GS (i) » Motor and Gear Train Stiction Valves 

KT(i) = Motor torque sensitivity constants 

RT (i ) « Total resistance of motor winding and output impedence 

of driver amplifier 

KG(i) = Gear train ratio 

KB (i) « Motor viscous damping constants 

XC = X and Y tip position of Master 

XM = X and Y tip position of manipulator 

Kl, K 2, K3, K4, K5, K6 = diagonal gain matrices 

TC = Torque distribution matrix for the Master 

TM *8 Torque distribution matrix for the manipulator 

CA, MA = Diagonal gain matrices 

Jl, J2 * Jacobian matrices relating joint rates to tip rates 
CT - Coordinate transformation matrix 

MM = Diagonal gain matrix used to select different multi-mode 

values 

PI = Position index bias signals 

CV = Master joint rates 

MV = Manipulator joint rates 

X (1) « Master shoulder joint position 

X (2) » Master shoulder joint rate 

X(3) = Master elbow joint position 

X(4) - Master elbow joint rate 

X(5) = Manipulator shoulder joint position 

X(6) = Manipulator shoulder joint rate 

X(7) “ Manipulator elbow joint position 

X(8) = Manipulator elbow joint rate 

TA(i) = Master input disturbance torques 

TB(i) « Manipulator input disturbance torques 

Rll(i) = Master servo motor drive signals 

R22 (i) = Manipulator servo motor drive signals 

TL(i) = Motor -gear train torque limit values 

RL(i) 83 Motor-gear train rate limit values 

= D-enotes integration 
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XC. = 

xc(l) 


(a+b) 


XC (2) 


(c-+d) 


a = (I£)COS (X (1)) 
b = (I£)C0S(X(1) + X (3)) 

c = (LC)SIN(X(l)) 
d a (IC)SIN (X (1) + X (3) ) 


XC = 

XC(1) 


(LC) 

C0S(X(1)) + C0S(X(1) + X(3)) 



XC (2) 


(LC) 

SIN (X (1)) + SIN(X(1) + X (3) ) 



2. XM 

XM is a two dimensional vector denoting the X and Y tip 
position of the manipulator. This tip position is calculated 
from a knowledge of the manipulator shoulder, X(5), and elbow, 
X(7), angular position. The derivation for XM is identical 
to that for XC and therefore, by comparison, 


ai = 

XM (1) 


(IM) 

COS (X (5) ) + COS (X (5) + X (7)) 


XM (2) 


(LM) 

[siN (X (5) ) + SIN (X (5) + X (7) )J 


3. PI 

PI is a two dimensional vector representing the X and Y 
bias voltages needed for positional indexing. When the master 
is position indexed from location XC^ to location XC„ , the 
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difference between these two tip position locations is cal- 
culated and used as a bias value that is summed with XC . 

4. K1 

K1 is a diagonal 2x2 gain matrix with the two diagonal 
elements equal. The K1 elements determine the X forward loop 
gain of the master servos and thus are inversely proportional 
to the master servo compliance. 

5. K2 

K2 is a diagonal 2x2 gain matrix with the two diagonal 
elements equal. The K2 elements determine how much positive 
tip rate feedback is incorporated into the master servo system. 
Positive rate feedback can be (but may not necessarily be) used 
to overcome the viscous damping of the servo motor and thus 
make the master easier to move. 

6. K3 

K3 is a diagonal 2x2 gain matrix with the two diagonal 
elements equal. The K3 elements determine how much differential 
tip rate feedback is used in the master servo system. Differ- 
ential rate feedback is used to help stabilize the system and 
acts to give good transient damping yet does not degradate 
"easy of movement" for steady state conditions. 

7. K4 

K4 is Kl* s counterpart for the manipulator arm. 

8. K5 

K5 is K2' s counterpart for the manipulator arm. 

9. K6 

K6 is K3* s counterpart for the manipulator arm. 

10. TC 

TC is the master torque distribution matrix and is one 
of the more important parts of the overall control system. 

The inputs to TC are signals that represent force values the 
master is to exert on its environment. These force values 
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must be transformed into torque values that the shoulder and 
elbow servo motors can produce. To derive this matrix, con- 
sideration is given to the external applied forces and inter- 
nal generated torques that act on the master in equilibrium, 
as pictured in Figure III-8, 


XC (2) 


F 

y 


xc(i) 


Figure III-8 Master Torques and Forces at Equilibrium 

Considering first only the elbow to tip segment of the master 
as shown in Figure III- 9, the equilibrium torques about point 
E are summed to give. 




0 = T. 


X(3) 


CF ) (LC)COS(X(l) + X(3» + (F ) (LC)SIN(X(l) +X(3», 

y ^ 
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Figure III-9 Equilibrium Torques and Forces on Master 
Upper Segment 


( 1 ) 

T X(3) = (-WOsragtfl) + X(3))(F x > + (LC)COS(X(l) + X(3))(F y ). 


Accounting now for the equilibrium conditions of the elbow 
to shoulder segment, as shown in Figure III-10, 
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Figure III-10 Equilibrium Torques and Forces on 
Master Lower Segment 

the torques about point S are summed to give. 


L T s = 0 “ T X(1) -CF y )(i£)coscx(D) + CF X )(LC)SINCX(1)) - t x(3) . 


Solving for T ..... and substituting from equation (1) yields 
X (U 

T X(D = ( " LC) [ SIN ^<D) + sin(x(i) +x(3))]cf k ) + (U3) jcos(x(i)) 
+ C0S(X(1) + X(3))J CF y ). (2) 


Putting equations (1) and (2) in matrix form gives: 


T X(1) 

R 

1 

CO 

V-/ 

l< 


C-LC) js'IN (X (1) )4SIN(X (1)+X (3))J (LC) [*qOS (X (1))-KJ0S (X (1)+X (3))J"| I 


(-LC) SXN(X(1)+X(3)) 


(LC) COS (X(l)+X(3)) 


■LV 
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This equation relates the tip forces, in equilibrium, that the 
master applies to its environmental when the shoulder and elbow 
torque motor are producing ^(1) anc * ^X(3) un *- ts torque, 

respectively. Therefore, the TC matrix is given by 


TG = 


(-LC) [siN (X (1) )-fSIN (X (1)+X (3) )j (LC) [cOS (X (1)+C0S (X (1)+X (3))J 


(-LC) SIN (X (1)+X (3)) 


(LC) COS (X (1)+X (3)) 


11. TM 

TM is the manipulator torque distribution and is derived 
in the same fashion as TC. The TM matrix is given by: 


TM = 


(-LM) ^SIN (X (5))+SIN(X (5)+X (7))J 


(1M) [cOS (X (5) )+COS (X (5)+X (7) ) 


(-IM) SIN(X(5)+X(7» 


(LM) COS (X (5)+X (7)) 


12. J1 

J1 is the Jacobian matrix relating master joint rates to 
the X, Y tip rates. It was shown that the master tip position 
is given by: 


XC(1) = (LC) C0S(X(1)) + COS (X (1) + X (3)) 
XC (2) = (LC) [siN (X (1)) + SIN(X(1) + X(3)) 


(3) 

(4) 
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If the first derivative of these equations with respect to 
time are denoted by 


d feUU L * XCD(l) 
dt 

■ 4 . C X . G . . ^ 2 )I, s XCD (2) 


and letting 


ihliiL = x(2) 


.^iL=X(4), 


the time derivatives of equations (3) and (4) are 


XCD (1) = 


axe Cl) 
ax(i) 


x<2) + -i^- x w 


XCD < 2 > ■ -Uto 1 ' x ' 2 > + -§7 § l x < 4 >- 
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Evaluating these equations yields in matrix form 


XCD = [XCD(1)“ 


(-LC) j^SIN (X (1))+SIN (X (1)+X (3))J (-LC) SIN (X (1)+X (3)) 

LxCD (2)_ 




(LC) [cOS(X(l))+COS(X(l)+X(3))J (LC) COS (X (1)+X (3)) 


From this equation it is seen that the J1 Jacobian matrix is 


J1 


(-LC) jsiN(X(l))+SIN(X(l)+X(3))J 


(-LC) SIN (X (1)+X (3)) 


(LC) [COS (X (1) )+COS (X (1)+X (3))j 


(LC) COS (X (1)+X (3) ) 


13. J2 

J2 is the Jacobian matrix relating manipulator joint rates 
to X, Y tip rates. By analogy to Jl, it is derived to be 


J2 = 


(-LM) [siN (X (5))+SIN (X (5)+X (7))J (-LM) SIN(X(5)+X(7)) 


(LM) COS (X (5))+C0S (X (5)+X (7)) (LM) COS (X (5)+X (7)) 



14. MM 

MM is a diagonal gain matrix with all diagonal elements 
equal. It is used to set the multi-mode ratio selected by 
the operator. As an example, suppose it is desired that the 
master and manipulator tip displacement ratio is 1:10; that 
is, for every one unit moved by the master, the manipulator 
moves 10 units. To obtain this ratio, the MM matrix would 
equal 


MM = 


10 


0 


0 



4 


15. CT 

CT is the coordinate transformation matrix that transforms 
the XC tip position of the manipulator in the XC , or fixed axis 
system, to the value of this tip position in the XM , or oper- 
ating axis system. 

The CT matrix is derived as shown below. Consider the two 
axis systems XC and XM shown in Figure III- 11. 
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XC (2) 


Let; 


The 



XG(1) 


Figure III-ll Two Axis System Showing Derivation of 
Coordinate Transformation Matrix 

(1) X be vector representing manipulator tip position, 

(2) a. be unit basis vectors in XC axis, 

i — 

(3) b . be unit basis vectors in XM axis, and 

i — 

(4) 0 be rotation angle between the axis XC and XM. 


a^ can be expressed in terms of the b^ as; 


a l P ll^l + P 2^2 


a 2 P 1 B 1 + * 22^2 


(5) 

( 6 ) 
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where P - C0S8, - -SIN©, P^ « SIN©, P n - C0S8, and the 

vector X can be expressed as either 


X = XCCl)^ + XG (2)a 2 » XM(l)b + XM(2)b 2 , (7) 


Substituting equations (5) and (6) into (7) yields 


X = XC (1) [p il b 1 + ^ 2 b 2 + XG (2) ^ 1 b 1 + ^ 2 b 2 J = XM(l)b 1 + XM(2)b 2 , 


Simplifying produces 


CXC(l)P n + XC(2)P 21 )b 1 + (XC(1)P 12 + XC(2)P 22 )b 2 = XtiCDbj^ + XM(2)b 2; 


and comparing coefficients of the b^ gives 


~XM(1)" 


rp 

ii 



’xc(l)“ 

XM(2) 


p 

L 12 

— 1 

CM 


XG (2) 


( 8 ) 


Equation 8 transforms the tip position of the manipulator 
in the fixed, or base axis system, XC, into the value of this 
tip position in the operating or XM axis system. Substituting 
for the P. . yields 
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XM(1) 


cose 

SIN0 


XC(1) 

XM(2) 


-SING 

cose 


XC (2) 


( 9 ) 


and thus CT is shown to be 


CT = 


cose 

-SING 


SING 

cose 


5. Design Philosophy 

a. Operational Requirements - As a guideline for the 
design of the electronics that will interface the master and 
slave arms, basic operational criteria must be specified. 

Some of this criteria is "general", in that no unique design 
numbers exist due to the systems flexibility with man "in 
the loop" , some of the criteria is obtained from past research 
on bilateral force reflecting remote manipulators, and still 
other of the guidelines are a result of personal intuition 
on how this X reference frame control system should operate. 
The four primary operational requirements that must be con- 
sidered for this, as well as any other bilateral manipulator 
system, are as follows. 

1) Compliance - Compliance is a measure of the servo 
"stiffness" of a manipulator system. As has been pointed out 
by past work in the field, the stiffer the servo loops the 
more readily man- in- the- loop can adapt and control a remote 
manipulator. Unfortunately, there is an upper bound on how 
stiff a servo loop can be made due to the high gains that 
evolve which result in destabilizing the system. Compliance 
can easily be measured by rigidly attaching the manipulator 
to an immovable object and then applying a torque to one of 
the master joints. The ratio of angular displacement of the 
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joint to the applied torque is the compliance number for that 
joint. The literature has shown that a compliance of 2 x 10“ ^ 
rad/ ft. lb is a workable number for a one-to-one joint coupled 
bilateral manipulator. For an X reference frame control 
system, the compliance will be given as the feet displaced 
at the master tip in the X or Y direction to the lbs applied 
force of the tip in the X or Y direction for a rigidly fixed 
manipulator. It is hoped that the two DOF breadboard can 
be designed with an X and a Y compliance figure of 0,5 x 10"^ 
ft/ lb. The gain matrix K1 in Figure III-6 determines the 
master compliance and therefore must be, to meet the 0.5 x 
10” 3 ft/ lb figure, given by 


K1 = 


2000 


0 


0 2000 J . 


2) Operating Speed - The speed at which the master 
and slave move (let this speed be denoted by X) under the 
influence of an operator applied input force is a function 
of the system gains, gear friction, and the internal viscous 
damping of each servo motor. The greater the force needed 
to move the arms, the greater the degradation in the force 
feedback qualities of the system. Thus it is desirable to 

X 

maximize the ratio — , where F . is the minimum input force 

™ — — —mm 

~min 

needed to set the system in motion, to its largest possible 
value and still maintain a workable system stability. From 
initial work, it appears that a value of 


X 


F . 
mm 


1 ft/ sec 
1 lb 
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will be possible to obtain for both the X and Y directions, 

3) Force Reflection - The force reflection ratio 
between master and slave is probably the easiest of the opera- 
tional criteria to obtain. The ratio of the forces applied 
at the master to those applied at the manipulator is given by 


Force ratio = 


K1 

K4 


( 10 ) 


Actually equation (10) violates a fundamental property of 
matrix algebra and should be more correctly stated as 


Force ratio in X direction 


S UM ) 

K4(l, 1) 


(ID 


Force ratio in Y direction 


K1 (2. 2) 
K4 (2, 2) 


( 12 ) 


The two D.O.F, breadboard is being designed with a force 
reflecting ratio of 1, and therefore equations (11) and (12) 
indicate that K1 = K4. From the compliance criteria K1 has 
been defined, and thus K4 is given by 


K1 = K4 


r2000 


01 


(13) 


0 2000 
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4) Stability - System stability is the most critical 
and the most difficult of the criteria to achieve. The system 
must be stable for: 1. all arm configurations, 2, operating 

with the multi-mode feature active, 3. master and slave oper- 
ating in different axis systems, 4. master short circuited 
and open circuited (tip of master both held on to and not held 
on to by the operator), 5. manipulator short circuited and 
open circuited (tip of manipulator both in contact with an 
object or load and allowed to move free), and 6. any combin- 
ation of circumstances 1. through 5. Unfortunately, there is 
no "cook book" procedure for a system design that will guar- 
antee total stability. Several of the parameters in the two 
D.O.F. control scheme that can be varied to achieve the desired 
system stability will be briefly discussed below. 

b. Options in Design - There are several options in the 
design of the two D.O.F. breadboard that can be used to 
obtain the desired stability. First of all, as shown in 
Figure III-6, differential tip rate feedback has been included 
to provide transient damping without effecting the steady state 
• 

X 

p value. Thus, the gain matrices K3 and K6 are parameters 

—min ' 

that can be varied to effect stability. There exists the 
option of configuring the DC servo motors at each joint in 
either a voltage or current drive made. In the voltage drive 
configuration, the internal viscous damping of each motor 
becomes significant and thus provides desirable stability 
qualities but tends to greatly degrade the 



p ratio. To obtain a workable p - ■ ■■ ■ value, positive tip 

-min —min 

rate feedback can be introduced but this naturally has a 
detrimental effect on stability. In the current drive con- 
figuration, the motor internal viscous damping is negligible 
which yields a large value for 

• 

X 

p but leaves the system highly understabilized. To provide 

-min 

the necessary stability, shaping filters and differential tip 
rate feedback can be used. These shaping filters, placed in 
the input circuit to each servo motor, are of the lead- lag 
variety and provide the needed gain and phase shift to stabilize 
each servo closed loop. 
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c. Methods of Analysis and Design - Both frequency and 
time domain techniques are being used to analyze and design 
the two D.O.F. control system. As a first step, the total 
closed loop system is divided into its four individual com- 
ponents. These four components undergo a piecewise lineari- 
zation and a frequency domain stability analysis is conducted. 
The appropriate gain functions and filters are designed to 
assure the stability of each servo loop considered individually. 
Unfortunately, analyzing each linearized servo system separ- 
ately does not reveal the stability qualities of the total 
closed loop control system. To investigate the total system 
behavior, time trajectories to simulated force inputs are 
obtained by programming the control system on the digital 
computer, which performs the needed integrations via a 
numerical integration routine. These time trajectories 
reveal the overall system stability qualities, and thus an 
iterative update design procedure is obtained between the 
frequency and time domains. This procedure is repeated until 
a control system that meets all the general operational cri- 
teria is developed. 

6. Frequency Domain Analysis 

a. Individual Joints - As seen from the definitions of 
Section III. A. 4, the X reference control scheme as shown in 
Figure .111-6 is highly nonlinear. Unfortunately, nonlinear 
systems present some difficulties in their analysis and design 
due to the inapplicability of standard frequency domain tech- 
niques to such systems. In an effort to analyze, by hand, 
in the frequency domain, the two D.O.F. control system, the 
servo motors and their associated closed loops for each joint 
are considered individually. These individual systems are 
piecewise linearized and a frequency domain design is con- 
ducted on the various gains and shaping filters to assure 
stability. After this is done, the complete system is re- 
united and time trajectories are obtained to investigate 
the total nonlinear closed loop system behavior. 

1, Consider first the master shoulder joint servo motor 
and its various inputs as shown in Figure III- 12. To in- 
vestigate the stability of this system with respect to an 
input disturbance torque, Ul, the manipulator and master 
elbow joints are held fixed, and therefore the rate inputs 
U4, U5, and U6 are zero and the position inputs U2 and U3 
are constant for any particular arm configuration. To cal- 
culate the open loop transfer function for this system, for 
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all permissible locations the master shoulder joint can obtain 

under normal operation, the signal content at point e in 

Figure III- 12 must be known. To obtain this information, 

each of the b. and X. must be determined. 
x x 


Letting: 


U1 = U1 


U2 = (LC) 

L C <V +C<K 10 + U7) ] 

U3 » (LC) 

[s cx 10 ) + S cx l0 + U7)] 

U4 = U5 = 

U6 = 0 

U7 = X (3) 


X(1)= x 10 + x(l) 


= initial condition on X(l) 

G = COSINE 

S = SINE 


and from the variable definitions of Section III, A. 4 the 

b and X. are seen to be 
i ' i 




X = 
1 


(-r£)(Kl)^GCX i0 +X(l))-fOCX 10 +X(l)W7)J +(K 1 ) (LC) jc (X^-fC (X 1Q -HJ 7 ) 
(-K2* ) (LC) js (X 1Q +X (1))+S (X 1Q +X (l)-HJ 7 )~J X(2) 

0 

("LC) (Kl) [S (X 10 +X(l))+S (X 10 +X(l)+U7)j +(I£) (Kl) Js (X^+S (X^+UI) 
(LC)K2« ) jc (X 1Q +X (1))4C (X 1Q +X (1)-HJ7)J X (2) 

0 . 


III-30 



Forming the sums ^ ^ and E X^, and operating on these 
i=l i=l 

signals with the torque distribution matrix TC and the gain 
matrix CA. results in e given by 


= (CA) (-LC)Js (X 10 +X(l))+S (X 10 +X(1)-HJ7J>J times 
' (-LC) (Kl) [c (X 1Q +X (1))+C (X 1() +X (1)+U7)J 
+ (K1) (LC) [c (X 1Q )+C a i0 +U7)J 
L- (K2> ) (LC) [S (X 1Q +X (1) )+S (X 1Q +X (1)+U7)J X (2) 
+ (CA) (LC) jc (X 10 +X(l))+C (X i n +X (1)4U7)~| 


10 


times 


(-LC) (Kl) js (X 1Q +X (1))+S (X 10 +X(1)-HJ7)J 
+ (LC) (Kl) Js (X 10 )+S (X 10 -HJ7)] 

L+(LC) (K2* ) Jc(X 10 +X(l))+C(X l0 +X(l)-HJ7)Jx (2). 


Simplifying 


e = (CA) (Kl) (LC) ‘ 


S (X 1q )-H3 (X 10 -HJ7) 


■ ( 


I 


C(X 10 )+C(X 10 +U7) 


C(X 10 +X(1))4€ (X l0 +X(l)+U7) 


< 

L 


S (X l0 +X (l))+S (X 10 +X (l)+U7) 


+ (CA) (K2* ) (LC) a (2) |~[S (X 1Q +X (1) )+S (X^+X (1)+U7)] 2 +[C (X^+X (1))+C (X^+X 


(1)+U7)] 2 J 
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Simplifying 

e = (GA) (K2‘ ) (LC) 2 X (2) |l+l+2S (X l0 +X (1» S (X 1Q +X (1)+U7)+2C (X lQ +X (1) ) C (X^+X <1)-HJ7 


+ (CA) (Kl) (LC)" 


s (x 10 )c (x 10 +x(i))-c(x 10 )s cx 10 +x(i))+ 

S (X 1Q ) G (X 1Q +X (1)+U7)-C (X 10 )S (X^+X (1)-HJ7) + 

S (X 1q -HJ7)C CX 10 +X(1»-C(X 10 -HJ7)S (X 1Q +X(1))+ 

S (X 10 +U7)C (X 1Q +X (1)-HJ7)-CCX 10 -HJ7)S (X^+X (1)+U7) 


Simplifying 

e = (GA) (K2* ) (LC) ^ (2) [2+2C (U7)] 

+ (CA) (Kl) (LC) 2 [S (-X (1))+S (-X(l)-U7)+S (U7-X(l))+S (-X(l))]. 


Simplifying 

e = (2) (GA) (K2‘ ) (LG) 2 [l+C (U7)] X (2) 

- (CA) (Kl) (LC) 2 [2S (X (1) )42S (X (1) )C (U7)], 


Simplifying 

e = (2) (CA) (K2« ) (LC) 2 [l+C (U7)]X(2) (14) 

- (2) (CA) (Kl) (LC) 2 [14C (D7)] S (X (1) ) . 

The above equation reveals that e is composed of a linear term 
in rate, X(2), and a nonlinear term in position, S(X(1)), Re- 
membering that equation (14) was derived for any position of 
the master shoulder joint, and as was shown in Section A.4,c. the 
system will have a small compliance number, X(l) will vary 
only small amounts around X^ for all expected values of Ul. 

Therefore S(X(1)) can be linearized around the origin as shown 
in Figure III- 13 to result in 
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S(X(D) = K X(l), 

b 

S(X(1)> K s 

X(l) 


Figure III-13 Piecewise Linearized S(X(1)) Function Around Origin 

where K is the slope of the piecewise linearized curve. Under 
this linearization, equation (14) becomes 

e *= (2) (GA) (K2’ ) (LC) 2 Jl+C (U 7)J X (2) 

- (2) (CA)K1) (LC) 2 (K g ) ^14€(U7)Jx(l) ; 

and Figure III~12 can be simplified as shown in Figure III-14. 
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Figure III-14 Linearized Form of Master Shoulder Servo Loop 


Letting G-( S) = 1, the open loop transfer function e/p is 

easily calculated to be (15) 


(2) (1+C (U7))(Kl)(K s ) 
= (KFL(l)) (KFB(1>) 


(Kl) (K g ) 



g 

s (1+ (KFL(l)) (kei(i» (kfb(i)T 5 


From a knowledge of the servo motor parameters and the system 
gains Kl, K2, and K3, equation (15) reveals open loop charac- 
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teristics and can be used to determine the needed compensating 
filter to assure relative stability. This technique can there- 
fore be used to stabilize the master shoulder servo closed 
loop system considered, it is remembered, only as a subsystem 
and thus does not guarantee satisfactory performance when the 
servo is operated as a member of the total system. 

The master elbow servo system, Figure III- 15 can be treated 
in an identical fashion as above to determine its relative 
stability about any position the elbow can achieve under normal 
operation. The value of e, derived in the same manner as that 
of equation (14), becomes 


e = (CA) (K.2* ) (LC) 2 X (4)- (CA) (I £) 2 (K1)S (X <3» . 


( 16 ) 


Once again approximating S(X(3)) in the region of the origin 

by K X(3) yields 
s 


e = (CA) (K2 » ) (LC ) 2 X (4) - (CA) (LC ) 2 (Kl) (K )X ( 3) . 

s 


Figure III- 15 can now be reconstructed as shown in Figure 
III- 16. 


Letting G ? (S) = 1, the open loop transfer function e/o is 
easily calculated to be 


(Kl)(K s ) 

e/ J# = (KFB (2)) (KFL(2)) 


1 + (Kl) (K ) 

(-k 2 ’) S 

s (1 + § 

U (KFL (2)) (KEI (2) ) (KFB (2) ) 



Proceeding with a similar analysis on the individual man- 
ipulator joints as was conducted above on the master joints, 
the manipulator shoulder servo loops exists as shown in 
Figure III-17. e is calculated to be 


e - (MA) (MM) (2) (K5 ' ) (LM) 2 [l+C (U7)j X (6)- QlA) (MM) (2) (K4) (LM) 2 [l+C (U7)J S (X (5)) 

(18) 
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Figure III-15 Master Elbow Servo System 






















(CA)(LC) 2 (KI)(K j 
s 


Figure III-16 Linearized Form of Master Elbow Servo Loop 
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Figure III-17 Slave Shoulder Servo System 
















Letting S (X (5) ) = K X(5) 

s 


for small values of X(5), Figure .1X1-17 can be redrawn as 
shown in Figure III- 18 



Figure III-18 Linearized Form of Manipulator Shoulder Servo Loop 

Letting G 2 (S) = 1 » the open loop transfer function is cal- (19) 

culated to be 

2 (LM) 2 (1+C (U 7) ) (K4) (K g ) (MM) 
e/ £ = (KFL (3) ) (KFB (3) ) 


D, The manipulator elbow servo subsystem is shown in Figure 
HI-19, e is derived to be 



e = (MA) (MM) (K5) (LM) 2 X (8)- (MA) « (LM ) 2 (K4)S (X (7) ). 
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Figure III-19 Slave Elbow Servo System 


















7. Time Domain Analysis 

The final analysis of the total system becomes somewhat 
difficult in that now no piece of the system can be held 
rigid while another piece is analyzed, A complete system 
linearization must be performed for both the forced and un- 
forced situations. This linearization results in investi- 
gating the system behavior around equilibrium points, of 
which there are an infinite number, and provides a linearized 
system with time varying coefficients for the forced case. 
Almost to the point of being facetious, it can be said that 
this type of analysis becomes horrendous for an eighth order 
system (sixteenth order if all compensating filters are 
included). Therefore an easier method for determining the 
behavior of the total closed loop system must be found, If 
the frequency domain is now abandoned and attention is given 
to the time domain, it is realized that an easier method does 
exist. This easier technique consists of examining the 
systems time trajectories for various inputs, or forcing 
functions, and is described in detail in the following section. 

a. Digital Program - To obtain time trajectories for the 
resultant motion to various input forcing functions for the 
system of Figure III-6, the servo motors and control laws are 
modelled and programmed, in Fortran IV, with the resultant- 
program designed for execution on a CDC 6400 computer. The 
system motion is described by eight first order nonlinear 
differential equations. The time solutions to these equations 
are obtained by iterative integration using the Kutta Merson 
integration routine. The inputs to the program are; 1. all 
system variables, 2. all initial conditions, and 3. the exter- 
nal forces applied at the tip of the master and manipulator; 
the outputs are: 1. motion of all joints, 2. rate of all 

joints, 3, tip motion of master and slave, 4, tip rates, and 
5, torques generated by all servo motors. The program can 
simulate the servo motors connected in either the voltage or 
current drive modes and includes the nonlinearities intro- 
duced by motor torque and rate limits. See Appendix D for 
program listing. 

The program consists of five major parts. Each of these 
parts provides the functions as described below. 
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Part I: 


1. reads in all data 

2. writes out all input data 

3. defines the coordinate transformation matrix CT 

4. computes the composite servo parameters KFL (i) (forward loop), 
KEI(i) (reflected inertia), and KFB (i) (servo viscous damping) 

5. calls numerical integration routine 

6. stores results of numerical integration routine 

7. prints out time histories in tabular form 

8. plots each time history on a separate graph 

Part II: 

Part II is the Kutta-Merson numerical integration subroutine. 

One of the formal parameters passed into this subroutine is the name of 
another subroutine which contains the eight' first order differential 
equations that describe the motion of fche master-slave system. 

Part III: 

Part III is the ,, FIRDER ,, subroutine that defines the eight first 
order differential equations that describe the system. The program 
input data, read by the main program (Part I), is passed into this 
subroutine by means of common block storage. 

Part IV: 

Part IV is a short subroutine that seeks out the minimum and maximum 
values of each trajectory to be plotted. 



Part V: 


Part V is a scale subroutine that scales all axes for trajectory 
plotting. 

b, Results of Digital Program 

As stated previously, the first output function of the program is 
to print out all input data. A sample print out follows. 

TWO DIMENSIONAL BILATERAL MANIPULATOR PROGRAM 


INPUT DATA 

K1 

2000. 000 

0. 

K3 

20. 000 

0. 

K5 

6.500 

0. 

CA 

.799 

0 . 

MM 

1. 000 

0. 

GS 

0 . 

PI 

0. 

RR 

0. 

KT 

. 149 


0. 

2000. 000 


0 . 

20. 000 


0 . 

6.500 


0. 

.799 


0. 

1. 000 


0. 


0. 


0. 


.149 


K2 

6.500 

0. 

K4 

2000. 000 

0. 

K6 

20. 000 

0. 

MA 

.799 

0. 


.149 


0. 

6.500 


0. 

2000. 000 


0 . 

20. 000 


0. 

.799 


.149 
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RL 


1.500 

1.500 

TL 

28. 125 

28.125 

RT 

11.900 

11. 900 

KG 

100. 000 

100.000 

KB 

.200 

.200 

JM 

o. 

0. 

£ 

11 

o 

• 


LC = 1.000 

IM = 

STIME = 1. 000 


NEQ = 8 STEP = 

.005 


T = 0. 


X(l) 

X (2) 

X(3) 

.523 

0 . 


X (5) 

X (6) 

X<7) 

1.122 

0 . 



FG 

0. 1. 000 

FM 

0 . 0 . 

END OF INPUT DATA 


1.500 

1.500 

28. 125 

28.125 

11. 900 

11.900 

100. 000 

100. 000 

.200 

.200 

0 . 

0 . 


2.000 


X(4) 

- 1. 045 0. 

X(8) 

-2.244 0. 
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Those values in this print out that have not been previously defined 
in Table m_i are* 

1. KT = torque sensitivity value of each servo motor 

2. RL = rate limit for each joint 

3. TL = torque limit for each servo-gear train combination 

4. RT = total resistance of motor winding and driver ampli- 

fier output impedence for each servo motor 

5. KG = gear train reduction value 

6. KB = viscous damping of servo motor 

7. JM = reflected inertia at each joint due to load at tip 

of master or slave 

8. RA *= coordinate axis rotation angle 

9. LC *= length of master arm segments 

10. LM = length of manipulator arm segments 

11. STIME » length of run time for program 

12. NEQ = number of first order differential equations to be 

handled by numerical integration subroutine 

13. STEP = print out interval 

14. T = initial time 

15. X(i) = initial values of joint positions 

16. FC = X and Y tip forces applied to master 

17. FM = X and Y tip forces applied to manipulator 

The tabular print out of the time functions will not be presented 
as that information can more readily be shown by the trajectory plots. 
To avoid a lengthy explanation of each plotted function, three examples 
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will be given that show the plotted results of actual computer 
runs. 

A, Example I 

This example demonstrates the force reflecting properties 
of the system. The servo motors are modeled in the voltage 
drive mode, a moderate amount of differential tip rate feed- 
back is included, and the external applied forces on the tip 
of the master and manipulator are (10 lbs, 10 lbs) and (-10 
lbs, -10 lbs), respectively. The master and manipulator tips 
are initially placed at (1.7 ft, 0), Since equal and opposite 
external forces are placed on the master and manipulator, it 
is expected that the system will undergo initial transients 
with the steady state condition revealing no motion and the 
individual joint servo motors actuated to oppose the exter- 
nal applied forces. As seen by the time trajectories, this 
is indeed the case. 

In the following plots, angular position is given in 
radians, angular rate in radians/second, tip position in 
feet, tip rate in feet/second, and torques in foot lbs. 
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TWO DIMENSIONAL BILATERAL MANIPULATOR PROGRAM 


INPUT DATA 




K1 



K2 


2000. 000 

0. 

0 . 

0 . 


0. 

2000. 000 

0. 

0 . 

K3 



K4 



20. 000 

o. 

2000. 000 

0. 


o. 

20.000 

0. 

2000. 000 

K5 



K6 



0. 

0. 

20. 000 

0. 


0. 

0. 

0. 

20. 000 

CA 



MA 



. 799 

0. 

.799 

0. 


0. 

.799 

0. 

. 799 

MM 

1.000 

0 * 




0. 

1. 000 



GS 

0. 

0. 

0. 

0. 

PI 

0. 

0. 



RR 

0. 

0. 



KT 

.149 

. 149 

.149 

.149 

RL 

1.500 

1. 500 

1.500 

1.500 

TL 

28.125 

28.125 

28. 125 

28.125 

RT 

11. 900 

11. 900 

11. 900 

11. 900 

KG 

100. 000 

100. 000 

100. 000 

100. 000 
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KB 

. 200 . 200 . 200 . 200 
JM 

0 . 0 . 0 . 0 . 

RA = 0. 

LG = 1.000 LI = 2.000 

STIME - 1.000 

NEQ = 8 STEP = .005 

T = 0. 


X(l) 

.523 

X (2) 

X (3) 

o. 

-1.046 

X (4) 

X(5) 

1.122 

X (6) 

X (7) 

0. 

-2.244 

X (8) 

FC 

10. 000 


10. 000 



FM 

-10. 000 


-10. 000 




END OF INPUT DATA 
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5.275-01 
5.270-01 
5 .265-01 
5.260-01 
5.255-01 
5.250-01 
5.245-01 
5.240-01 
5.235-01 
5.230-01 
5.225-01 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

xti) vs tiie 

1 MASTER SHOULDER POSITION Xtl) 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

X(2) VS TIME 

1 MASTER SHOULDER VELOCITY X(2) 


-1.042+00 
-1.044+00 
-1.046+00 
-1.048+ 00 
-1 .050+00 
-1.052+00 
-1.054+00 
H. 056+00 
-1.058+00 
-1.060+00 
-1 .062+00 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

X(3) VS TIME 

1 MASTER ELBOW POSITION XC3) 



0 . 


2.000-01 4.000-01 6.000-01 8.000-01 1.00 


X(4) VS TIME 

1 MASTER ELBOW VELOCITY 


X(4) 


m-5o 
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b. Example II - 

In this example the servo motors are modeled in the voltage 
drive mode, there is no differential or positive tip rate 
feedback, the external applied forces on the Master are (0, 1 lb), 
and external forces on the manipulator are (0, 0). Both arms 
are initially placed at (1,7 ft, 0), As seen from the time 
trajectories, this system is considerably underdamped and has 
a very poor X ratio. 

F . 

-mm 
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TWO DIMENSIONAL BILATERAL MANIPULATOR PROGRAM 


INPUT DATA 




K1 



K2 


2000. 000 

0. 

0. 

o. 


0. 

2000. 000 

0. 

0. 

K3 



K4 



0. 

0. 

2000. 000 

0. 


0. 

0. 

0. 

2000. 000 

K5 



K6 



0. 

0. 

0. 

0. 


0. 

0. 

0. 

0. 

CA 



MA 



.799 

0. 

.799 

0. 


0. 

.799 

0. 

.799 

MM 

1. 000 

o. 




0. 

1, 000 



GS 

0. 

0. 

0. 

0. 

PI 

0, 

0, 



RR 

0. 

0. 



KT 

,149 

.149 

.149 

.149 

RL 

1.500 

1.500 

1.500 

1.500 

TL 

28.125 

28. 125 

28.125 

28. 125 

RT 

11. 900 

11. 900 

11. 900 

11.900 

KG 

100.000 

100. 000 

100. 000 

100. 000 
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KB 

.200 


.200 

.200 


.200 

JM 

o. 


0. 

o. 


o. 

RA » 

0. 





LC = 

1.000 

LM = 2. 000 




STIME « 

1.000 





1! 

00 

STEP = 

.005 




T = 

0. 

- 




X(1) 

.523 

X (2) 

X (3) 

0. 

X (4) 

-1.046 

0. 


X(5) 

1.122 

X (6) 

X (7) 

0. 

X (8) 

- 2. 244 

0. 


FC 

0. 


1.000 




FM 

0. 


0. 





END OF INPUT DATA 
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0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

X(fJ VS Tire 

1 MASTER SHOULDER POSITION X C 1 ) 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

X12) vs nre 

1 MASTER SHOULDER VELOC I TY X (2) 


-1.000+00 

-1.005+00 



8.000-02 


X<3> 

1 


2.000-01 4.000-01 6.000-01 8.000-01 1.00 


vs time 

MASTER ELBOW POSITION 



X<3) 


X<4) 

1 


2.000-01 4.000-01 6.000-01 8.000-01 1.00 


vs Tire 

MASTER ELBOW VELOCITY 


X(4) 


m-58 





0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

XCM) VS TIME 

1 MASTER X TIP POSITION XCM) 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

XCOI1) VS TIME 

1 MASTER X TIP VELOCITY XCD.M) 


9.000- 02 

8.000- 02 

7.000- 02 

6.000- 02 

5.000- 02 

4.000- 02 

3.000- 02 

2.000- 02 

1.000-02 

-2.220-16 

-1.000-02 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

XCC2) VS TIME 

1 MASTER V TIP POSITION XC (2) 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

XCD (2) VS TIME 

1 MASTER Y TIP VELOCITY XCD (2) 


m-6o 





in -62 


c. Exam pl e I II - 

In this example the servo motors are modeled in the current 
drive mode, there is no differential or positive tip rate 
feedback, the external applied forces on the Master are (0, 1 lb), 
and the external forces on the manipulator are (0, 0). Both 
arms are initially placed at (1. 7 ft, 0). As seen from the time 
trajectories, the system is totally unstable due to the almost 
complete absence of any internal damping. 
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TWO DIMENSIONAL BILATERAL MANIPULATOR PROGRAM 


INPUT DATA 




K1 



K2 


2000. 000 

0. 

0 . 

0 . 


0 . 

2000. 000 

0 . 

0 . 

K3 



K4 



0 . 

0 . 

2000. 000 

0 . 


0 . 

0. 

0 . 

2000. 000 

K5 



K6 



0 . 

0 . 

0 . 

0 . 


0 . 

0. 

0 . 

0 . 

CA 



MA 



.06720 

0 . 

. 06720 

0 . 


0 . 

, 06720 

0 . 

.06720 

MM 

1.000 

0 . 




0 . 

1, 000 



GS 

0 . 

0 . 

0 . 

0 . 

PI 

0 . 

0 . 



RR 

0 . 

0 . 



KT 

.149 

.149 

.149 

.149 

RL 

1.500 

1. 500 

1.500 

1.500 

TL 

28.125 

28.125 

28.125 

28.125 

RT 

11. 900 

11. 900 

11. 900 

11. 900 

KG 

100. 000 

100. 000 

100. 000 

100. 000 
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KB 

.00042 .00042 .00042 .00042 

JM 

0 . 0 . 0 . 0 . 

RA = 0. 

LG = 1. 000 IM = 2. 000 

STIME - i. 000 

NEQ = 8 STEP = .005 

T - 0. 


x(i) 

.523 

X(2) 

o. 

X (3) 

-1.046 

X(4) 

o. 

X(5) 

1.122 

X(6) 

o. 

X(7) 

-2.244 

X(8) 

0 . 


FC 

0. 1. 000 

FM 

0 . 0 . 

END OF INPUT DATA 
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1.000+01 


5.000+00 




0 . 

2.000-01 

4.000-01 6.000-01 8.000-01 

1.00 

0 . 

2.000-01 

4.000-01 

6.000-01 

8.000-01 


"TQC1J 

vs 

Tire 


TQ £21 

vs 

Tire 




1 

MASTER SHOULDER TORQUE TQ{13 


1 

MASTER ELBOW TORQUE 

TQ(2) 





0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

TGf3) VS TIME: 



0. 2.000-01 4.000-01 6.000-01 8.000-01 1.00 

tq n vs nre 


nr - to 


1 


SLAVE SHOULDER TORQUE 


TQ<3) 


SLAVE ELBOW TORQUE 


TQ(4) 


B. SERVO SYSTEM DESIGN 

1, Two DOF Breadboard Controller-Manipulator Physical Characteristics 

Before proceeding to the actual design and analysis of the 
two D. 0,F, control system, the physical characteristics of the 
breadboard hardware will be reviewed so that these characteristics 
can be used in transforming the previously discussed control law 
generalities into the needed electronics to interface input con- 
troller and output manipulator. 

Figure II.I- 2 7 depicts the completed arms with motors, tacho- 
meters, and potentiometers. All physical dimensions are given 
on the schematic of Figure III-21* and will therefore be omitted 
here. In contrast to Figure HI-21, the potentiometer at each 
joint was moved from the output shaft to the shaft that is one 
mesh removed from the input drive. As with many designs, hind- 
sight was greater than foresight in that the center to center 
distances for each gear mesh were not made adjustable and the 
overall gear trains resulted with appreciable backlash. This 
backlash accompanied with high loop gains (low compliance bi- 
lateral system) resulted in intolerable nonlinear limit cycling. 

To alleviate this problem, higher turn potentiometers were ob- 
tained and placed closer to the input shafts. Normally the price 
paid for this type of solution is a degradation in tip position 
accuracy, but tip accuracy is only meaningful for a manipulator 
system with computer commanded inputs. Since the breadboard manipu- 
lator was designed to operate with man-in-the-loop, tip accuracy was 
meaningless, and thus no penalty was paid for this particular sol- 
ution to reduce the backlash effects. 


The mechanical parameters of interest to the servo system 
design are; 

1. Motor characteristics 

2. Gear characteristics 

3. Inertia properties 

It is noted that no optimization procedure was used for se- 
lecting the motor and gear train at each joint. For the sake 
of expediency, the same Inland prehoused Tach-Torquer was 
used for both joints of master and slave and initially the 
same gear train was used for all joints. As indicated below, 

* Mechanical design of the breadboard and Figures III- 21 
through III-26 are contained in Appendix F, 
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Figure III-27 Two DOF Manipulator With Air Bearing Load 


the master shoulder and elbow gear ratios were modified 
slightly to reduce friction levels and yield an input controller 
with an 8 lb tip force capability. 

Tables III- 2, III- 3, and III- 4 summarize the motor, gear, 
and inertia properties associated with each joint. The inertia 
numbers are actual measured values and represent the inertia 
reflected to the output shaft of all rotating members (beam 
structure, gears, shafts, motor rotor, potentiometer shaft, 
etc.) associated with a particular joint. 

Table III- 2 


Motor Characteristics (All joints have 

same motor) 

Manufacture: 

Inland 

Model: 

NT2173 

Peak Torque; 

0.281 ft lbs 

Power Input, at Peak Torque: 

57 watts 

Viscous Damping, Infinite Impedence 
Source : 

0. 0000625 ft lbs/ rad/ sec 

DC Resistance; 

11.8 ohms 

Volts at Peak Torque; 

22.4 volts 

Amps at Peak Torque: 

1.9 amps 

Torque Sensitivity: 

0.149 ft lbs/amp 
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Table III- 3 


Gear Train Ratio 


Joint 

Gear Ratio 

Master Shoulder 

62:1 

Master Elbow 

29:1 

Slave Shoulder 

100:1 

Slave Elbow 

100:1 


Table III-4 


Inertia Properties 



Joint 


Inertia Reflected to Output Shaft 

Master Shoulder 

Elbow ~ 0° 
Elbow = 90° 

0. 90 ft lbs sec^ 
0. 86 ft lbs sec 

Master Elbow 


0.434 ft lbs sec^ 

Slave Shoulder 

Elbow = 0° 
Elbow = 90° 

1.97 ft lbs sec? 
1.62 ft ibs sec 

Slave Elbow 


0. 781 ft lbs sec^ 


2. Control System Design 

As indicated in the above discussion, after the control 
laws have been formulated that yield a system with all the 
required operational qualities, the foremost problem in the 
control system design becomes that of developing the com- 
pensating circuitry that will provide an unconditionally 
stable servo system. 
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As revealed by the above time trajectories, using tacho- 
metric feedback as the primary stabilizing technique produces 
very undesirable effects for a bilateral force reflecting 
system. Since it is desired to minimize the forces needed to 
produce motion in the master controller when the slave is 
free to move, any negative tachometric feedback present in 
the system tends to increase the required input force. Thus, 
with tachometric feedback, a force to velocity ratio exists 
for all non steady state conditions, and if differential 
tachometric feedback is not used, a force to velocity ratio 
will exist also for all steady state conditions. This force 
to velocity relationship is clearly undesirable for a bilateral 
system since it tends to degrade the operator’s sense of feel 
for inertial and externally applied forces acting on the slave 
member. Tachometric feedback has other undesirable qualities 
in that although it can be used to stabilize a system, it 
cannot simultaneously optimize other system parameters such 
as bandwidth, rise time, resonant frequency, etc. 

Due to these considerations, the use of tachometric feed- 
back was abandoned and it was decided to use network compen- 
sators (lead- lag filters) for stabilizing all portions of 
the system. The design of compensating filters for each of 
the servo subsystems was accomplished by frequency domain 
techniques as described below. 

a. Master Shoulder Joint - Figure III- 12 represents the 
master shoulder servo system with its various signal inputs. 

For a given initial position (equilibrium point) of the master 
and slave, this system can be linearized as previously described 
to yield the linearized system shown in Figure III- 14, where 


G x (s) = 


(kfl(D) (KEI (1)) 

S + (KFL (1) ) (KEI (1) ) (KFB (1)) 


( 22 ) 


and 


G ^ (s) = needed compensating filter. 
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To find the needed transfer function for G (s), the open loop 
transfer function e/fi must be obtained. From Figure III- 14 
e//3 is seen to be 


(2) (14€(U7» (Kl) CK ) 
e/j8 s — - s ,_ 

(KFL(l)) (KFB(l)) 


S 

1 + (Kl) (K ) 

(-k 2 ' ) 

s r r "" " 

+ (KFL(l)) (KEI(l)) (KFB (1)P 


( 23 ) 


Taking worst case condition for the Bode gain of equation 

(23), (C(U7) = 1), and remembering no tachometric feedback is 

to be used, and setting K - 1; the above equation becomes 

s 


e /|8 = 

(KFL (1)) (KFB (1» 


__ 1 

S(1 + (KFL (1) ) (KEI (1)) (KFB (1)) ) 


(24) 


Since the values for KFL(l), KFB (1) , and KEI(l) are given by 
the motor, gear, and inertia characteristics of the master 
shoulder joint, the remaining unknown in equation (24) is 
Kl, the master system forward loop gain. It was originally 
hoped that Kl could be set as high as 2000; although this is 
theoretically feasible, it was found that the computer 231R 
analog computer used to program the control equations has a 
significant 60 Hz noise problem and Kl could not be raised 
much beyond 300, Using this value of Kl, the values from 
Tables III-2, III- 3, and TII-4 and the definitions in Table 
III-l, the variables of equation (24) are given by; . 


Kl 

= 300 


KG (1) 

= 62.2 


KFL(l) 

= 9.28 


KFB (1) 

- 0.02615 - current 

drive, infinite impedence source 

KEI (1) 

= 1.09 - worst case 

inertia, elbow = 0° 

LG 

- 1 


CA 

- 0.108 
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and e/0 becomes 


e/0 = 6612 


S(1 + 


0.263 


') 


( 26 ) 


Figure III-28 depicts the Bode plots of the gain and phase 
curves for the transfer function of equation (26), and 
reveals, as expected, the intolerable stability parameters of: 

Gain Margin (GM) - -18db 

Phase Margin (PM) = 0° 

Figure III- 28 reveals that lead compensation is needed in the 
w = 50 rad/ sec vicinity in order to yield workable values for 
GM and PM. Inserting the network filter 


G 2 (s) 


1 + 


16.4 


1 + 


54. 7 


(27) 


with a zero to pole ratio of 0,3, the Bode plots of the open 
loop transfer function become shifted as shown in Figure III-29. 
From this figure it is seen that the gain and phase margins 
now have the acceptable values of- 


GM = 30db 
PM m 24° 


(28) 


Due to the high gain crossover frequency in Figure III-28, the 
compensating network of equation (27) has "tail-end" effects 
that extend into the 60 Hz frequency range. Since, as stated 
earlier, the analog computer used generates 60 Hz noise, it 
was decided to insert the 60 Hz notch filter 


= S 2 + 396S + (381) 2 
S 2 + 792S + (381) 2 
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(rad/sec) 





in order to reduce the dither generated in the servo motors. 
It is noted that this filter has a notch ratio of only 0.5. 
Lower notch ratios could not be used due to the undesirable 
phase shift characteristics introduced in the gain crossover 
region. With the noise filter introduced in the circuit, the 
lead compensator of equation (27) must be modified to retain 
allowable values of GM and PM. This modified filter 


G 2 (s) 


1 + 17 


1 + 


85 


(30) 


has a zero to pole ratio of 0.2 and yields total open loop 
gain and phase curves given by Figure III-30. From these 
curves it is seen that the final compensated linearized system 
has the following stability margins, 

GM = 12db 

(31) 

PM = 23° 

Summarizing these results, the compensated master shoulder 
linearized servo subsystem is given as shown in Figure III- 31. 



Figure III-31 Compensated Master Shoulder Linearized Servo Subsystem 
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Sys tem 











b. Master Elbow Joint - Figure III-15 represents the master 
elbow servo subsystem and its associated signal inputs. Pro- 
ceeding as in the above section, this system is linearized about 
any initial master-slave position to produce the linearized 
system show in Figure III- 16. 

where 


r = (KFL(2))(KEI(2)) 

G l { ' S + (KFL (2)) (KEI (2)) (KFB (2) ) 


(32) 


and 


(s) = needed compensating filter. 


The open loop transfer function e//3 is seen to be 


e/0 = 


(Kl) (K g ) 

(KFB (2)) (KFL (2)) 


(Kl) (K ) 

ll mrr 

g 

S (1 + "(KFL (2)) (KEI (2)) (KFB (2)) > 


(33) 


From the discussion of Section III.C. 2 and Tables III-l, III-2, 
III- 3, III-4, the variables of equation (33) are given by 
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K1 

= 

300 

K 

s 


1 

KG (2) 

8S 

29.6 

KFB (2) 

" 

0. 0124 

KFL (2) 

= 

4.41 

CA 

= 

0.227 

-K2* 


0 

LC 

■« 

1 

KEI (2) 

S3 

2.31 


and e/0 becomes 


e/0 = 7312 


S(1 + 


0.124 


) 


(34) 


Figure III- 32 represents the Bode plots of e/0 and reveals 
that the uncompensated system has stability margins of 


GM * -23db 
PM = 0°. 


(35) 


Inserting the lead compensator 




1 + 


1 + 


11.2 


(36) 


in the circuit yields the Bode plots of Figure III- 33 and the 
system is now seen to have 
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Figure HI-32 Bode Plots of Uncompensated Open Loop Linearized Master Elbow Servo System. 






GM = 30db 


( 37 ) 


PM = 24°. 

Once again attenuating the 60 Hz noise with the notch filter 


G = 5 2 + 396S + (381) 2 
f S 2 + 792S + (381) 2 

and modifying G„ (s) to 


(38) 


G 2 (s) 


1 + 14 


1 + 


70 


(39) 


yields the Bode plots of Figure III- 34 for the total compen- 
sated system. Figure III- 34 reveals the open loop stability 
margins to be 

GM = 16db 

(40) 

PM = 28° 

and Figure III- 35 represents the completely compensated master 
elbow linearized servo subsystem. 
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With 60 hz. Notch Filter 



Figure III-35 Compensated Master Elbow Linearized Servo System 


c. Slave Shoulder Joint - Figure III- 17 depicts the slave 
shoulder servo subsystem and its various signal inputs. 
Linearizing this system around any initial master-slave 
position results in the system of Figure III- 18, 
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where 


G 1 (s) 


(KFL (3)) (KEI (3)) 


S + (KFL (3) ) (KEI (3» (KFB (3)) 


and 


(s) * needed compensating filter. 


The open loop transfer function is 


2 (LM) (1 + C (U7)) (K4) (K ) (MM) 

s 


*4® " (KFL (3» (KFB (3)) 


S 

(K4)(K ) 


S (1 + 


(KFL (3)) (KEI (3)) (KFB (3)) 


) 


From Section III.C.2 and Tables III-l, III-2, 111-3, III-4, 
the variables of equation (41) are defined to be 


K4 

ss 

300 

K 

s 

= 

1 

KG (3) 


100 

B (3) 

= 

0.042 

KFL (3) 

8 S 

14.9 

KEI (3) 

S5 

0.508 = worst case inertia 

MA(1) 

** 

0.0672 

K5‘ 

* 

0 

LM 

*5 

2 


- 0 ° 
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Shoulder Servo System 




MM = 1 worst case multi-mode value 
C(U7) = 1 worst case position of slave elbow 


and e/j3 becomes 


e/0 - 10240 


1 

S (1 + 



( 42 ) 


Figure III-36 presents the Bode plots of equation (42) and 
reveals the uncompensated stability margins to be 


GM = -23db 
PM = 0°. 

Inserting the filter 


(43) 


G 2 (s) 


1 + 


1 + 



(44) 


the compensated system has Bode plots given by Figure III- 37 
and gain and phase margins of 


GM m 30db 
PM = 22°. 


(45) 


Attenuating the 60 Hz noise with 
G fo) = 

t S + 792S + (381 ) 1 

and modifying G 2 (s) to 


(46) 


G 2 (s) 


1 + ~- 

24 


1 + 


120 


yields the Bode plots of Figure III-38 for the total compensated 
system. Figure III- 38 reveals the open loop stability margins Jo be 

GM ■ 17db 


PM * 22°. 


(47) 
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Figure III-39 Compensated Slave Shoulder Linearized Servo Subsystem 


Figure III- 39 shows the completely compensated slave shoulder 
linearized servo subsystem. 

d. Slave Elbow Joint - Figure III- 19 shows the slave 
elbow servo subsystem and its associated signal inputs. 
Linearizing this system around any initial master-slave 
position results in the system of Figure 111-20^ 
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where 


q ( S) = (KJL(4))(KEI(4)) 

1 S + (KFL(4)) (KEI (4)) (KFB(4)) (48) 


and 


G 


2 


(s) = needed compensating 


filter. 


The open loop transfer function is given by 


(LM) (MM) (K4) (K g ) 
e/ £ = (KFB (4)) (KFL (4)) 


S 

(K4) (K ) 

1+ TvT 

( s ~ 

S (1 + (KFL (4)) (KEI(4)) (KFB (4))' 


(49) 


From Section III.C.2 and Tables III-l, III-2, III- 3',' III-4, 
the variables of equation (48) are given by 


K4 


300 

K 


1 

s 



KG (4) 

= 

100 

KFB (4) 

= 

0. 042 

KFL (4) 

= 

14.9 

KEI(4) 


1.28 

MA(2) 

= 

0. 0672 

K5* 

= 

0 

LM 

= 

2 

MM 

ss 

1 
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and e/g becomes 


=2556 


S (1 + 


0. 922 


( 50 ) 


Figure III-40 shows the Bode plots of equation (50) and reveals 
the uncompensated stability margins of 


GM = -3db 


PM = 0°. 


Letting 


G 2 (S > 


1 + 


i * 




(51) 


(52) 


the Bode plots of the compensated system are given by Figure 
III-41 and the gain and phase margins become 


GM = 30db 
PM = 22° 


(53) 


Attenuating the 60 Hz noise with 

G (s ) - S ' + 3 ** 
f S + 792S + (381) 

and redesigning G 2 ( s ) to 


1 + 


G 2^ s ^ ~ 


17 


1 + 


83 


(54) 


(55) 
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(rad/ sec) 

Slave Elbow Servo System 





ompensated Open Loop Lin' 


yields the Bode plots of Figure III-42 with gain and phase 
margins of 


GM = lOdb 

(56) 

PM = 16°. 

The totally compensated slave elbow servo subsystem is 
represented by Figure III-43, 




Compensated Open Loop Lineai 


Figure III-43 Compensated Slave Elbow Linearized Servo Subsystem 
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c, TEST RESULTS 


1 Two DOF Breadboard Test Plan ' 

The test plan for the two DOF breadboard must be a pro- 
cedure that demonstrates, or investigates, all the foreseen 
and unforeseen operational characteristics of breadboard hard- 
ware and electronics. The investigation of the operability 
of the breadboard is divided into five general areas: 

1. Bilateral operation, ; 

2. Coordinate t r ans f ormat ions 

3. Position indexing 

4. Variable gain ratio 

5. Stability 

By necessity, the documentation of the tests conducted in 
these five areas will be both objective and subjective. Many 
of the system’s characteristics can be determined by well 
defined definite procedures that are conducted via man- not- in - 
the-loop techniques. The characteristics determined in this 
manner reveal the Basic operational qualities of the system. 

Since the breadboard manipulators are bilateral force \ 
reflecting that require inputs from a human operator, the man- 
in- the-loop characteristics of the system must likewise be 
determined., Man has his own unique transfer function (this’ 
function differing from person to' person) that .results in a 
servo system having man- not -in- the -loop basic operational 
qualities that differ marked from the man- in- the- loop complex 
operational qualities. To document these complex operational 
qualities the investigator must subjectively evaluate system 
performance for various bilateral tasks. 

The following test plan will investigate the five afore- 
mentioned areas by determining the following properties of 
the system. 

1. Unpowered hardware characteristics 

2. Force reflecting properties 

3. Coordinate indexing capabilities 
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4. Position indexing capabilities 

5. Variable gain ratio operation 

6. Stability (man- not - in- the -loop) 

7. Stability (man-in- the-loop) 

8. Large payload handling characteristics 

9. Bandwidth 

10, Unilateral operation 

11, Unilateral - bilateral task time comparisons 
2, Bilateral Operation 


Of primary importance in any bilateral manipulator is the 
mechanical aspects of both master and slave. Although the 
theoretical characteristics of the breadboard hard- 
ware are given in the mechanical section of this report, follow 
ing are the actual measured values of stiction, inertia, and 
backlash for each joint of master and slave. 


a. Stiction 
Master elbow; 
Master shoulder; 
Slave elbow: 
Slave shoulder: 

b, Inertia 
Master elbow; 
Master shoulder: 

Slave elbow: 
Slave shoulder: 


T g = 0.56 ft lbs 
T g = 1.06 ft lbs 
T s = 1. 77 ft lbs 
Tg =1.52 ft lbs 


I = 0.43 ft lbs sec 


elbow = 0° 


= 0,90 ft lbs sec* 


1 it, - ono * 0.86 ft lbs sec 
elbow = 90 

I « 0,78 ft lb sec 2 


I no = 1.97 ft lbs sec 

elbow = 0° 

1 it, - ono = 1*62 ft lbs sec' 
elbow = 90° 
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c. Backlash 


Master elbow: B = 5.51 min 

Master shoulder: B = 7.44 min 

Slave elbow: B = 2.98 min 

Slave shoulder: B = 6.09 min 

To document the force reflecting properties of the bread- 
board, the force reflection ratio was measured, in the X and 
Y directions, for various arm positions (all with position 
indexing) with differing variable gain ratio values and with 
master and slave operating in different coordinate systems. 

The forward loOp gains Kl and K4 are equal for all measure- 
ments and thus theoretically the force reflection ratio should 
be 1;1 for all test cases. As seen from the slopes of the 
following graphs, the force reflecting ratio is very nearly 
1:1 for all measurements with any inconsistencies arrising 
from measurement and analog computer gain setting inaccuracies. 

For each of the following test cases (Figures III-44 through 
III-48), the initial slave position and the indexed master 
position are given, the values of the variable position gain 
ratio MM and the coordinate transformation rotation angle RA are 
noted, and plots of the force reflecting ratio in the X and Y 
direction are included. 


Compliance 


The compliance of a bilateral manipulator system is a 
measure of its servo stiffness. For the two DOF breadboard 
control system, the compliance, in either the X or Y direction, 
is inversely equal to the forward loop gain Kl. The compliance 
is measured by immobilizing the slave and measuring the dis- 
placement to force ratio in both the X and Y directions. 

Figures III-49 and III-50 reveal the measured compliance to 
be very near its theoretical value and indicate that system 
compliance, like the force reflecting ratio, is independent 
of the variable gain ratio MM, the coordinate transformation 
roll angle RA, and the position indexing vector PI. 


Tracking 


Part A 


To document the operability of position indexing, variable 
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Y Force on Slave (lbs) 


Figure III-46 Force Reflecting Ratio, Configuration 3 
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Figure III-48 Force Reflecting Ratio, Configuration 5 
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gain ratios, and coordinate transformations between master and 
slave, the following tracking curves are presented. Various 
MM, RA, and PI values are introduced into the system, the tip 
of the master is then moved, in a straight line along a guid- 
ing bar, in the X and Y direction and the tracking capability 
of the tip of the slave is recorded. The following curves 
(Figures III-51 through III-60) plot master and slave tip 
position as a function of time. Each figure indicates the 
master-slave initial positions, the direction in which the 
tip of the master was moved, and the appropriate values of 
MM and RA. As revealed by the traces, the tracking properties 
of the system are excellent with respect to all three properties 
(position indexing, variable gain ratios, and coordinate trans- 
formations) and there is no detectable "cross talk" between 
pure X and pure Y motions. 

5. Tracking - Part B 

As a second part to the tracking problem, it was desired 
to investigate the transient behavior and stability properties 
of the breadboard system to man in the loop inputs. Input 
trajectories similar to those in the preceding section were 
provided, only now the object was to stop the tip of the master 
at some predetermined point. The trajectory was terminated 
by either driving the master to a peg or visually recognizing 
the end point scribe. The system was tested both unloaded 
and loaded with a 306 lbs weight (described in mechanical sec- 
tion) floating on an air bearing attached to the end of the 
slave arm (Figure III-27) . The 306 lbs weight was used to 
provide large slave inertial loading and both unilateral and 
bilateral testing was accomplished with the load attached. 

As seen from the following traces (Figures I II- 61 through 
III-69), the unloaded system has excellent man- in- the -loop 
tracking and stability qualities for all combinations of 
inputs and system parameters considered. For large inertial 
loads on the slave, it is seen that the slave is highly under- 
damped for unilateral (no force feedback to the operator) 
operation. This marginal stability is to be expected since 
the system was not designed for unilateral operation with 
high inertial loading. When operated in the bilateral mode 
with the large inertia load, it is noted that the system has 
both excellent track and stability qualities. The payload 
can be brought to the desired end point, deaccelerated and 
stopped by the operator with little to no overshoot. This 
bilateral handling quality for large payloads is likewise to 
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Figure HI-51 Tracking - Part A, Figure I 
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Figure HI -52 Tracking - Part A, Figure 2 
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Figure IH-53 Tracking - Part A, Figure 3 




Figure m-54 Tracking - Part A, Figure 4 
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Figure IH-55 Tracking -Part A, Figure 5 
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Figure HI-57 Tracking -Part A, Figure 7 
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Figure 3H-59 Tracking - Part A, Figure 9 




Figure m-60 Tracking - Part A, Figure 10 


RA = 0 

Time scale = 0. 1 sec/div. 

Master displacement scale - 0.0275 ft/div. 



Figure DI-61 Tracking - Part B, Figure I 
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Figure HI-62 Tracking - Part B, Figure 2 
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Figure IH-63 Tracking - Part B, Figure 3 
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Figure HI-64 Tracking - Part B, Figure 4 
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Figure UI-65 Tracking - Part B, Figure 5 
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Figure m-66 Tracking - Part B, Figure 6 



Figure IH-67 Tracking - Part B, Figure 7 
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be expected since equilibrium point oscillations are nulled 
by the fastest, or dominant member of the system 

- this member being the master con- 
troller. Thus, even though designed for unloaded operation, 
the bilateral feature allows the operator to compensate the 
system to yield a large payload handling capability. 

6. Bandwidth 


The bandwidth of any bilateral manipulator is determined 
by the slowest responding member of the system - this member 
being the slave arm. Thus, the bandwidth of the breadboard 
manipulator was determined by applying inputs on the tip of 
the master and recording the resulting motion at the tip of 
the slave. A pure Y oscillating input of + 0.092 ft was used 
to excite the master tip and slave motion was observed for 
MM values of 1/2, 1/4, and 1/8, Bandwidth measurements were 
made for the slave both unloaded and loaded (306 lbs weight 
and air bearing attached to slave tip), and Tables III- 5 
through III- 10 reveal the unloaded system capable of respond- 
ing to frequencies ranging between 3.0 Hz and 1.6 Hz and the 
bandwidth of the loaded system ranges between 0. 2 Hz and 
0.1 Hz. 

7. Sample Times 

In an attempt to secure preliminary information as to 
the needed sample rate for the digital interface of the two 
DOF breadboard manipulator, sample and hold circuits were 
inserted in the drive channels to each of the joint servo 
motors. Although sampling the output signals is certainly 
not equivalent to a true digital interface, it does reveal 
the nature of system dependency upon sample rate and does 
give an insight into needed computational time. 

Since sample rate is dependent upon system bandwidth, 
worst case conditions (unloaded slave arm) were investigated. 
Variable gain ratio values of MM = 1/2, 1/4, and 1/8 were 
used and both pure Y sinusoidal (+ 0.092 ft) and man-in-the- 
loop inputs were appiied to the master controller. As seen 
from Tables III-ll, III- 12, and III-13, both the objective 
and subjective conclusions as to system stability indicate 
allowable sample rates vary from 7 msec (MM = 1/2) to 61 
msec or slower for MM 4: 1/8. 
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Table III-5. Bandwidth Measurements, Unloaded, MM = 1/2 


MM = 

1/2 




RA « 

0° 




Pure 

Y input on 

master 



Frequency 

Input Y^ 

Output Y 
c m 

0.05 hz 

+ 0.092 ft 

+ 0.20 

ft 

0.1 

hz 

+ 0.092 ft 

+ 0.17 

ft 

0.2 

hz 

+ 0,092 ft 

+ 0.18 

ft 

0.8 

hz 

+ 0. 092 ft 

+ 0.19 

ft 

1.0 

hz 

+ 0.092 ft 

+ 0. 19 

ft 

1.4 

hz 

+ 0.092 ft 

+ 0. 20 

ft 

1.6 

hz 

+ 0.092 ft 

+ 0.21 

ft 

1.8 

hz 

+ 0.092 ft 

+ 0.23 

ft 

2. 0 

hz 

+ 0. 092 ft 

+ 0.21 

ft 

2.2 

hz 

+ 0.092 ft 

+ 0.19 

ft 

2.4 

hz 

+ 0.092 ft 

+ 0.18 

ft 

2.6 

hz 

+ 0.092 ft 

+ 0.16 

ft 

2.8 

hz 

+ 0.092 ft 

+ 0.15 

ft 

3.0 

hz 

+ 0.092 ft 

+ 0.13 

ft 


Table III- 

6. Bandwidth Measurements, 

Unloaded, MM = 

1/4 


MM = 1/4 


RA m 0 

Pure Y input on master 


U. 

► nz 

+ 0 . 

0.1 

hz 

+ o. 

0.4 

hz 

+ 0 . 

0.8 

hz 

+ o. 

1.2 

hz 

+ 0 . 

1.4 

hz 

+ o. 

1.6 

hz 

+ o. 

1.8 

hz 

+ 0 . 

2.0 

hz 

+ o. 

2.4 

hz 

+ o. 

2.8 

hz 

+ o. 

3.0 

hz 

+ 0 . 

3.4 

hz 

± 0 . 


092 ft 

+ 0.36 

ft 

092 ft 

+ 0.37 

ft 

092 ft 

+ 0.36 

ft 

092 ft 

+ 0* 37 

ft 

092 ft 

+ 0. 39 

ft 

092 ft 

+ 0.41 

ft 

092 ft 

+ 0.49 

ft 

092 ft 

+ 0.42 

ft 

092 ft 

+ 0.39 

ft 

092 ft 

+ 0. 30 

ft 

092 ft 

+ 0.27 

ft 

092 ft 

+ 0.23 

ft 

092 ft 

+ 0.17 

ft 







Table III- 7 Bandwidth Measurements, Unloaded, MM = 1/8 


MM = 1/8 





e 

n 

o 

0 





Pure Y input 

on master 




Frequency 


Input Y c 

Output 

Y 

m 

0.05 hz 


+ 0.092 ft 

+ 0. 84 

ft 

0.1 hz 


+ 0.092 ft 

+ 0. 77 

ft 

0. 2 hz 


+ 0.092 ft 

+ 0.75 

ft 

0.4 hz 


+ 0.092 ft 

+ 0.77 

ft 

0.6 hz 


+ 0. 092 ft 

+ 0.75 

ft 

0.8 hz 


+ 0.092 ft 

+ 0. 80 

ft 

1.0 hz 


+ 0.092 ft 

+ 0.75 

ft 

1.2 hz 


+ 0.092 ft 

+ 0. 75 

ft 

1.4 hz 


+ 0.092 ft 

+ 0.75 

ft 

1.6 hz 


+ 0.092 ft 

+ 0.60 

ft 

1. 8 hz 


+ 0.092 ft 

+ 0.48 

ft 

2.0 hz 


+ 0. 092 ft 

+ 0.45 

ft 

Table III- 8 

Bandwidth 

Measurements, 

Loaded, MM - 1/2 


MM = 1/2 





£ 

II 

o 

o 





306 lb load 

on slave 




Pure Y input 

on master 




Frequency 


Input Y^ 

Output Y 
m 

0.05 hz 


+ 0. 092 ft 

+ 0.27 


0.07 hz 


+ 0.092 ft 

+ 0.21 


0.10 hz 


+ 0.092 ft 

+ 0.21 


0.13 hz 


+ 0.092 ft 

+ 0.21 


0. 16 hz 


+ 0.092 ft 

+ 0.19 


0.19 hz 


+ 0.092 ft 

+ 0.21 


0.22 hz 


+ 0. 092 ft 

+ 0.23 


0. 25 hz 


+ 0.092 ft 

+ 0.24 


0.3 hz 


+ 0.092 ft 

Uncontrollable 
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Table III-9 Bandwidth Measurements, Loaded, MM = 1/4 


MM = 1/4 




O 

O 

11 

3 




306 lbs load 

on slave 



Pure Y input 

on master 



Frequency 


Input Y c 

Output Y 

m 

0. 02 hz 


+ 0.092 ft 


0.05 hz 


+ 0.092 ft 

+ 0.43 ft 

0.07 hz 


+ 0.092 ft 

+ 0.42 ft 

0. 09 hz 


+ 0.092 ft 

+ 0.42 ft 

0. 11 hz 


+ 0.092 ft 

+ 0.43 ft 

0,13 hz 


+ 0.092 ft 

+ 0.43 ft 

0, 15 hz 


+ 0.092 ft 

+ 0.44 ft 

0.17 hz 


+ 0.092 ft 

+ 0.48 ft 

0. 2 hz 


+ 0.092 ft 

+ 0.52 ft 

0. 24 hz 


+ 0.092 ft 

Uncontrollable 


Table III-10 Bandwidth Measurements, Loaded, MM = 1/8 

MM = 1/8 
RA = 0° 

306 lbs load on master 


Pure Y input on master 


Frequency 

Input Y c 

Output Y 
■ m 

0. 05 hz 

+ 0.092 ft 

+ 0,92 ft 

0. 07 hz 

+ 0.092 ft 

+ 0. 77 ft 

0.09 hz 

+ 0. 092 ft 

+ 0.87 ft 

0.12 hz 

+ 0.092 ft 

+ 1. 02 ft 

0, 15 hz 

+ 0.092 ft 

Uncontrollable 
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Table III- 11 Sample Rates, Unloaded, MM = 1/2 


MM = 1/2 
RA = 0° 




No load 

Frequency 

Input 

Output 

Sample Time 

Normal Oper. 

Human Oper, 

Very good 

0,4 msec 

Normal Oper. 

Human Oper. 

Very good 

5. 0 msec 

Normal Oper. 

Human Oper, 

Good 

6, 0 msec 

Normal Oper, 

Human Oper, 

Fair 

7. 0 msec 

Normal Oper. 

Human Oper. 

Fair 

10. 0 msec 

Normal Oper. 

Human Oper, 

Unstab le 

15. 0 msec 


Table III- 12 Sample Rates, Unloaded, MM = 1/8 


MM = 

1/8 




RA = 

0° 




No load 




Frequency 

Input 

Output 

Sample Time 

Normal Oper. 

Human Oper. 

Very good 

0.4 

msec 

Normal Oper. 

Human Oper, 

Very good 

9.5 

msec 

Normal Oper. 

Human Oper. 

Very good 

14.8 

msec 

Normal Oper. 

Human Oper. 

Very good 

20.0 

msec 

Normal Oper. 

Human Oper. 

Very good 

25.0 

msec 

Normal Oper. 

Human Oper. 

Very good 

32.0 

msec 

Normal Oper. 

Human Oper. 

Good 

41.0 

msec 

Normal Oper. 

Human Oper. 

Good 

50.0 

msec 

Normal 'Oper. 

Human Oper* 

Fair 

61.0 

msec 

Normal Oper. 

Human Oper. 

Fair 

80.0 

msec 

Normal Oper. 

Human Oper. 

Poor 

100 

msec 

Normal Oper. 

Human Oper. 

Unstable 

120 

msec 
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Table III- 13 Sample Rates, Unloaded, MM = 1/4 


MM = 

1/4 







RA m 

0° 







No Load 







Pure 

Y input on master 






Frequency 

Input Y c 

Output Y 
■ m 

Sample Time 



0, 1 hz 

+ 0.092 ft 

+ 0.41 

ft 

0.4 

msec 



0, 1 hz 

+ 0.092 ft 

+ 0.40 

ft 

0.8 

msec 



0, 1 hz 

+ 0. 092 ft 

+ 0.40 

ft 

2.6 

msec 



0.1 hz 

+ 0.092 ft 

+ 0.40 

ft 

4.2 

msec 



0. i hz 

+ 0.092 ft 

+ 0 # 4Q 

ft 

6.0 

msec 



0. 1 hz 

+ 0.092 ft 

+ 0.34 

ft 

9.5 

msec 



0.1 hz 

+ 0. 092 ft 

+ 0.40 

ft 

14.4 

msec— — l 

► Starting to 

chatter 

0. 1 hz 

+ 0. 092 ft 

+ 0.34 

ft 

19.5 

msec 



0. 1 hz 

+ 0.092 ft 

+ 0.34 

ft 

30. 0 

msec 



0.1 hz 

+ 0.092 ft 

+ 0.34 

ft 

45.0 

msec— 

►Totally unstable 

1.2 hz 

+ 0.092 ft 

+ 0.40 

ft 

0.4 

msec 



1.2 hz 

+ 0.092 ft 

+ 0,40 

ft 

7.6 

msec 



1.2 hz 

+ 0.092 ft 

+ O’. 40 

ft 

10. 8 

msec 



1.2 hz 

+ 0. 092 ft 

+ 0.38 

ft 

16.4 

msec 



1, 2 hz 

+ 0. 092 ft 

+ 0.38 

ft 

25.0 

msec 



1.2 hz 

+ 0.092 ft 

+ 0.42 

ft 

33.0 

msec— | 

► Starting to 

go 

1.2 hz 

+ 0.092 ft 

+ 0.42 

ft 

44.0 

msec 

unstable 


1.2 hz 

+ 0.092 ft 

+ 0.47 

ft 

50.0 

msec— H 

►Unstable 


2.0 hz 

+ 0.092 ft 

+ 0.44 

ft 

0.4 

msec 



2.0 hz 

+ 0.092 ft 

+ 0.34 

ft 

1.8 

msec 



2. 0 hz 

+ 0.092 ft 

+ 0.44 

ft 

11.2 

msec 



2. 0 hz 

+ 0.092 ft 

+ 0. 36 

ft 

16.4 

msec 



2. 0 hz 

+ 0.092 ft 

+ 0.44 

ft 

25.0 

msec 



2. 0 hz 

+ 0.092 ft 

+ 0.49 

ft 

37.0 

msec — h 

► Starting to 

go 

2. 0 hz 

+ 0.092 ft 

+ 0.44 

ft 

52.0 

msec 

unstable 


Normal Oper. 

Human Oper. 

Very good 

0.4 

msec 



Normal Oper. 

Human Oper. 

Very good 

6.0 

msec 



Normal Oper. 

Human Oper. 

Very good 

11.2 

msec 



Normal Oper. 

Human Oper. 

Very good 

16.4 

msec 



Normal Oper. 

Human Oper. 

Fair 


20.4 

msec 



Normal Oper. 

Human Oper. 

Fair 


25.0 

msec 



Normal Oper. 

Human Oper. 

Poor 


30. 0 

msec 
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8. Maze Times 


Figure III- 70 depicts the breadboard manipulator being 
used to negotiate a probe through a maze. This test was 
included in the system documentation procedures to reveal 
to those unfamiliar with manipulator systems one of the ad- 
vantages of bilateral over unilateral operation. Four test 
subjects were used and each was directed to guide the probe 
through the maze in the fastest possible time under both 
unilateral operation and bilateral operation with and with- 
out visual feedback. As seen from Table III- 14, virtually 
no difference in task times was noted, for any of the sub- 
jects, between bilateral operation with and without visual 
feedback. Also seen from the table, the difference in times 
to complete the task between the unilateral mode and bilateral 
mode varied with the experience of the operator^ with unilateral 
times ranging from 2 to 7 times greater than bilateral times. 
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Figure III-70 Breadboard Manipulator With Maze Test Board 



Table III- 14 Maze Task Times 


Unilateral 

Bilateral 

Bilateral 



No Visual 

With Visual 

Subject I, very experienced 

(seconds) 

(seconds) 

(’seconds) 


24.0 

8.00 

6.25 


19.0 

6.50 

8. 00 


14.5 

7. 00 

7.10 

It 

h-» 

4 ^ 

16.5 

11.00 

7. 00 

o 

O 

II 

2 

15.0 

8.50 

6.75 


13.5 

7.50 

7.50 

Subject II, experienced 

59.0 

8.9 

8.5 


19.9 

8.4 

9.7 


36.8 

7.3 

6.9 

MM = 1/4 

51.4 

7.8 

9.8 

RA » 0° 


7.5 

8.0 ' 



7.3 

7.5 

Subject III,' not experienced 

41.4 

+ 

58.6 lost 

10.0 


37. 7 index* 

11.3 

9.0 


Out of maze** 

15.2 

9.6 

MM = 1/4 

42.6 

13.3 

8.6 

RA. = 0° 

47.1 

11.6 

8.7 



9.0 

8.4 

Subject IV, experienced 

43.4 

10.0 

9.0 


61.1 

9.5 

9.4 


54.7 

8.7 

10.7 

MM = 1/4 

59.2 

8.7 

10.6 

£ 

11 

o 

o 


12.4 

10.8 



9.8 

11. o 



* It was the option of all subjects to position index the master 
controller at will. 

** Due to Subject Ill's inexperience, exceedingly high forces were 
applied in the unilateral mode and the probe was forced out of 
the maze. 

+ In the bilateral mode with no visual feedback, the subject, on 
his first run, became momentarily lost and had to hunt by trial 
and error for the proper path. 
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E, SUMMARY 

A control technique has been presented that allows a bi- 
lateral force reflecting manipulator to incorporate coordinate 
transformation, multi-mode operation, and position indexing. 

The technique uses an X reference frame control scheme which 
results in a highly nonlinear system. Servo system compensa- 
tion design is based on linearized control law equations and 
the procedures for deriving the needed filter networks are 
presented. 

To "prove the concept", in hardware, of the X reference 
frame technique, a two DOF master-slave breadboard was fab- 
ricated. The breadboard master and slave were interfaced 
with a EAI 231R analog computer on which the control law 
equations and compensating network were programmed. 

Testing of the breadboard system revealed the X reference 
frame force reflecting properties were truly independent of 
coordinate transformations, multi-mode operation, and posi- 
tion indexing. The coordinate transformations and multi-mode 
features operated perfectly, and it was realized that position 
indexing was not only a nicety but a necessity for teleopera- 
tors with a large master-slave size disparity. The X, Y tip 
compliance of the system was 0.003 ft/ lb; although originally 
it was hoped that a smaller compliance figure could be obtained, 
the achieved value did yield a workably stiff servo system. 

The tip to tip tracking properties were excellent, and it was 
demonstrated how man- in- the- loop serves as an adaptive filter 
for stabilizing a bilateral system handling a large payload. 

The tip to tip bandwidth of the unloaded system was experi- 
mentally determined to range from 3.0 to 1.6 Hz, with the 
loaded system (306 lbs inertia load on tip of manipulator) 
having a bandwidth ranging from 0.2 to 0.1 Hz, It was con- 
cluded that if the analog system were sampled, the tolerable 
sample rate varied from 10 msec OMM = 1/2) to 32 msec (MM = 1/8). 
To demonstrate one advantage of a bilateral system, a maze was 
negotiated with a probe attached to the end of the manipulator. 
Comparing unilateral and bilateral task times revealed the 
bilateral mode to be two to seven times more efficient. 
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IV. MANIPULATOR 


This chapter discusses three main areas: joints, counter^ 

balance, and overall manipulator design. The work on joints 
includes gear train breadboards, gear ratio/motor selection 
and final design. The latter is based on commercial quality 
components but has incorporated several space version require- 
ments; i.e. , envelope size, torque, etc. 

A counterbalance mechanism breadboard was designed and 
tested. Alternative techniques and final recommended design 
is discussed. An optimization technique was used to minimize 
the effect of the counterbalance on the arm dynamics and aid in 
the yoke design. 

The last section, overall manipulator design, includes a 
layout drawing of the 40 ft counterbalanced AMS. The design 
incorporates a counterweight clearance yoke which allows 
complete manipulator movement. 

A. JOINTS 

1. Design Requirements and Joint Alternatives 

Many techniques have been used and proposed over the years 
for providing the required torques and speeds for manipulator 
joints. Most systems were not weight or efficiency critical 
and many design configurations gave satisfactory 
results. However, for a system, with potential utilization 
in space, where a high degree of control is required, certain 
optimization is mandatory. This does not imply increasing 
mechanism complexity. It does mean that the design parameter 
tradeoffs must be considered more thoroughly; those such as 
weight, efficiency, reliability, backdrive ability, inertia, 
backlash, torsional elasticity, envelope volume, and so forth. 
The backdriveability requirement has a very strong influence 
on the selection of a torque multiplier system. 

It should be noted that the criteria for selecting the 
torque values and the drive types for the AMS is not related 
to the presence of gravity. The gravity load is overcome 
by counterbalancing (Section B). Therefore, the selection 
of a drive type is applicable for the SAMS as well as the 
AMS. 
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Several candidate speed reduction techniques for use in 
space manipulator joints have been shown in the past. Each 
has apparent advantages and disadvantages. The approach of 
this technology investigation is to (1) select three alter- 
native gear train types, (2) design and fabricate a full size 
breadboard of each gear train, (3) test each for static and 
dynamic friction, backdriveability, torsional deflection 
(wind-up), and backlash, (4) analyze the data and select the 
preferred gear train type, and (5) design three AMS joints 
based on the selected gear train type. The 1200 ft- lb shoul- 
der joint was the one selected to breadboard. 


With regard to a choice of overall ratio for the gear 
train breadboards several factors were considered. DC 
torque motors are available in a wide range of torques so 
that it was equally possible to use a low torque motor with 
a high gear ratio or a high torque motor with a low gear 
ratio. The need to have high backdriveability means that 
motor reflected friction must be low, which indicates a low 
gear ratio. In addition, if there are more meshes there are 
more sources of gear friction and thus a higher gear reflected 
friction. Based on previously designed and fabricated bread- 
board arms it was known that a simple Spur gear system could 
be backdriven if the ratio was in the vicinity of 100 or 200 
to 1, with up to four gear meshes. Beyond this, no concrete 
information was available. Most Harmonic Drives are limited 
to a ratio of 200:1 in a single stage. 

Based on the above reasoning a gear train ratio of 200:1 
was selected for the joint breadboards. An effort (parallel 
to the breadboard fabrication) was conducted to analytically 
tradeoff the gear train ratio vs motor size. The results 
of this analysis (discussed in part 3 of this section) points 
to a gear ratio of approximately 100; 1 for the 1200 ft-lb 
shoulder joint. Since this ratio is relatively close to that 
used in the breadboards, the latter test results are valid 
for comparison of gear train types for use on the AMS. 

The three gear train types selected for breadboarding 
are: (1) a harmonic drive, (2) a spur gear system with ex- 

ternal spur gears throughout, and (3) a double spur gear 
system with the final (output) member an internal spur 
(or ring) gear. The latter two are referred to as the "ex- 
ternal" and the "internal" drives, respectively. 
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2. Breadboards 


a. Design and Fabrication - The external and internal 
systems were designed and built by MMC. The harmonic drive 
was purchased from United Shoe Machinery (USM) Corporation. 

High strength, accurate gears were purchased for the internal 
and external drives. Standard commercial gears do not have 
the accuracy and strength which are necessary for a design 
which can meet the final envelope and backlash requirements. 

For example, the safe tooth loading of both cast iron or 
soft steel gears (commercial types) is in the order of 20,000 
lbs per square inch. Using high strength steel, safe tooth 
loading can be about 80,000 lbs per square inch. This strength 
factor of four reduces the width of the gears, thus producing 
significantly smaller envelope sizes. 


Because of the 200; 1 reduction ratio and the 12.0 inches 
envelope limitation for the drive housing in the test bread- 
board drive and furthermore the desire for no more than 3 
meshes, it was necessary to use enlarged shaped teeth pinions 
with 13 teeth. This way a full beam strength was achieved for 
the pinion teeth in contrast to what one would get with an 
undercut teeth pinion. 


In the two spur gear systems the following design guide- 
lines were used: 

1) Weight of test breadboards was not limited, 

2) Unground gears were used, 

3) Simplicity was a prime goal, 

4) Aluminum housings and external drive shafts 
with keyways were used for ease of connecting 
input and output torque loads, 

5) Approximately 12 inch overall joint diameter, 

6) Low backlash of less than 0.005 inches on output 
gear teeth, and 

7) Gears manufactured to AGMA-9 quality specifica- 
tions, using standard hobbing methods for 
cutting. 
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It should be noted that more rigid tolerance specifications 
(such as AGMA-10 to 14 could reduce backlash, but funding con- 
straints prevented this on these breadboards. For comparative 
evaluation a higher backlash was considered allowable. 

Harmonic drive - The harmonic drive uses an eccentric input 
drive to deflect a circular spline, engaging many small teeth 
at one time. Each rotation of the input advances the drive 
by one tooth, thus achieving a 20Q;1 ratio in one mesh. A 
model 8M (USM) harmonic drive was purchased for the 
breadboard tests. This drive has a 200:1 speed reduction 
ratio, and is rated for 1200 ft-lbs on the output shaft. The 
harmonic drive concept is shown in Figure IV- 1. The unit used 
for test was an off-the-shelf model (Figure IV-2) , although 
its components were selected (by the vendor) for best fit. 

Prior to the test the oil Was removed from the drive leaving 
only a light oil film. The input shaft seal was also removed 
to decrease the friction level. 

External Drive - A simple three mesh system was designed, 
each mesh ratio approximately 6:1 with a total reduction of 
199:1. This system consists of 20° spur gears in a single 
train. The backlash in this System was controlled with good 
dimensional tolerance and with some small adjustments avail- 
able during final assembly. 

In developing the gear and pinion specifications the 
basic Lewis Equation was used throughout. The velocities 
to be encountered are so low that the dynamic effects are 
inconsequential. Also, the pitch line velocity is so small 
that the Barth modification does not make any significant 
contribution. The major factor of importance is the safe 
tooth load stress which is dependent on the characterististics 
of the gear material. The material chosen was SAE4340 steel. 
Although full strength is not reached until RC45 or greater 
we allowed a relaxation of this to RC38 to enable final 
machining without grinding, after heat treatment. 

The breadboard concept and detail design is shown in 
Figures IV- 3 and IV-4. 

Internal Drive - The internal gear system is driven by a 
standard spur pinion, but then branched off into two spur gear 
trains driving a common ring gear. This drive uses adjust- 
ments in the double pinion drive to allow for assembly of the 
gears. 
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Figure TV- 1 Harmonic Drive Concept 
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Figure IV-2 Harmonic Drive, USM Model 8M 
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Figure IV- 3 Spur Gear Drives - Schematics 
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Figure IV-4 External Drive Breadboard Design 
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Figure IV- 5 Internal Drive Breadboard Design 




The internal drive also has three meshes, each approximately 
6:1, giving a total reduction of 199: 1. The external drive dis- 
cussion above regarding the Lewis and Barth relationships, and 
the material selected also applies to the internal drive. The 
internal drive breadboard concept and detail design is shown 
in Figures IV-3 and IV-5. 

b. Testing and Test Results - The following parameters 
are those evaluated and measured in the test program. 

1) Drive torsional elasticity (windup) through the 
total loading range (0 to 1200 ft-lbs), 

2) Breakaway (s fiction) torque through the total 
loading range (driving forward and backward), 

3) Frictional running torque loss at several accel- 
erations and velocities through the total loading 
range , 

4) Running efficiency at several accelerations and 
velocities through the total loading range, 

5) Backlash at input and output shaft, and 

6) Miscellaneous operating characteristics of each 
drive observed during the test. 

1) Test Set-up - Figure IV-6 is a schematic of the 
test apparatus. No motors or exterior gear drives were used. 

The drive mount is approximately 12 feet above the floor. The 
output shaft is equipped with a balanced arm from which weights 
are suspended. These weights produce an output torque up to 
1200 ft-lbs. On the input shaft is a pulley of known diameter 
over which is wound nylon cord from which the input weight is 
applied. The input load is accurately weighed. For the dyna- 
mic tests, a timer is wired to a limit switch at the input 
pulley and a limit switch at the stop point approximately 12 
feet below the input pulley. On release of the input weight 
the upper switch starts the timer. When the drop weight 
strikes the stop, the lower switch stops the timer. The 
timer is readable within 2 milliseconds. By accurately mea- 
suring the distance the weight falls, accelerations and velo- 
cities can be accurately determined. The maximum output 
velocities expected in manipulator operation are expected to 
be about 2 ft/ sec unloaded and 0.2 ft/ sec fully loaded. These 
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Protractor Scale 
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Figure IV- 6 Joint Breadboard Test Set-up 




accelerations and velocities were within the range obtained 
with the test set-up. 

Table IV- 1 shows the parameters that were measured during 
the tests and those that were calculated later, A digital 
computer program was written and used to reduce the data. 

2) Static Tests - Backlash and torsional windup at 
the input shaft were measured by a calibrated protractor 
located at the input shaft, A pointer fixed to the input 
shaft shows the angle traveled from the time weights were 
first applied till the time breakaway occurs. Backlash was 
first measured by manually rotating the input shaft while the 
output shaft is locked. Backlash at the output shaft was 
measured while the input shaft was locked. 

Table IV-2 shows a sample static breakaway torque test 
data sheet used for each drive for the forward drive mode. 

A weight was placed at the end of the balance beam to simulate 
output torque. This weight is recorded as output weight. A 
weight was applied at the input pulley until movement of the 
balance beam was detected on the dial indicator. This weight 
is recorded as input weight. At the same time, the windup 
angle was read at the input shaft to determine the windup 
angle. Torque on the input shaft was computed based on the 
weight and input pulley diameter of 6 inches. This torque 
multiplied by 200, the gear ratio for harmonic drive and 
199.3 for spur drives, provides the theoretical output torque. 
The output torque is the output weight times the beam length 
of 4. 75 ft. The actual output torque divided by the theoretical 
output torque is the static breakaway efficiency in percent. 
Actual drive static friction in ft-lbs is theoretical output 
torque less actual output torque. Backdrive static breakaway 
torque tests were run identical to the forward drive test. The 
data is handled identical to the forward drive test except 
windup data was not obtainable. 

By comparing input torque applied, to the output torque, 
static breakaway torque efficiency is determined. By sub- 
tracting the output torque from the input torque times the 
gear ratio, the actual friction torque of the drive is derived. 

Figures IV- 7 and IV-8 show the external and internal drives 
set up for testing. 
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Table IV- 1 Measured and Calculated Joint Data 


Test 

Measured Data 

Calculated Data 

Backlash 

Protractor reading 
in degrees 


Torsional 

Elasticity 

(Windup) 

Protractor reading 
in degrees 

Def lection of component s 
in drive and balance beam 

Static Break- 
away Torque 
Forward and 
Backward 

Input pulley, torque 
Output shaft torque 

Drive breakaway friction 
torque 

Drive static efficiency 

Dynamic driving 
characteristics 1 

| 

i : 

Weight applied to 
output 

Weight applied to 
input 

Input weight fall 
distance 

Input weight fall 
time 

Mass moment of inertia of: 

a. Input pulley 

b. Balance beam 

c. Drive 

Distance Travelled by: 

a. Input pulley (radians) 

b. Balance beam (radians) 

c. ! Output weight 



Acceleration of: 



o 

a. Input weight (ft/sec' 4 ) 

b. ; Input pulley (rad/ sec j 

c. Output weight (f t/ sec^) 

d. Balance beam (rad/ sec *) 



Final Velocity of: 


! 

a. Input weight (ft/ sec) 

b. Input pulley (rad/sec) 

c. Balance beam (rad/ sec) 

d. ' Output weight (ft/sec) 



Drive Running Friction 



Drive Torque Loss Due to 
inertia 
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Figure IV- 7 External Drive Under Low-Load Test 
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Figure IV-8 Internal Drive Under Low-Load Test 



Static breakaway torque values over the full range of 
output torques applied to the drive were obtained by the follow- 
ing procedure. 

1) Apply load to end of balance beam to simulate 
torque on drive output shaft, 

2) Set height gage under pin located on end of 
balance beam, 

3) Carefully add 'lead shot to container attached 

to cord on input pulley, and 

\ ' 

4) When the dial indicator shows movement of the 
output weight', reebrd the weight applied to the 
input side of the drive. 

Static test results are plotted in Figures IV- 9 through 
IV- 13. y 

3) Dynamic Tests 4 sample data sheet is shown in 
Table IV-3. Three tests were run at each output shaft load 
(50, 100, 150, 200 and 250 pounds). {The drop weight was in- 
creased for each test to provide, thtee different acceleration 
and velocity points. Each test' W,as Repeated four times, 
recording drop distance and time of drop. The average time 
and drop distance of the four drops, was used for the analysis 
of each test. \‘\ • 

By knowing the distance traveled by the Input weight and 
in what time period, distance traveled and elapsed time can 
be computed for the input shaft, output shaft and, output weight. 
From these tines and distances, average accelerations, final 
velocities, dynamic torque, kinetic energy values and effi- 
ciencies can be determined for each individual component of 
the system. 

Figure IV- 14 a and b show two typical dynamic test setups. 

Table IV- 4 lists the mass moments of inertia. These in- 
ertias are reflected to the input shaft for forward driving 
and reflected to; the output for •backdriving. 
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External Spur Gear Drive (3 Meshes) 
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Figure IV- 10 External Drive-Static Breakaway Torques 


Internal Spur Gear Drive 
(3 Spur Gear Meshes; Output Gear 
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Figure IV-11 Internal Drive-Static Breakaway Torques 







Backlash Adds: 


Output Torsional Windup 
(Arc Minutes) 



Figure IV- 13 Torsion Deflection of Three Drives 
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Table IV- 3 Samp le Data Sheet - Dynamic Test 
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Figure IV- 14a External Drive Under Low Load Dynamic Test 



Table IV-4 Mass Moment of Inertia 


Drive Type 

2 

Forward Drive (Slug-Ft ) 

Back Drive 

2 

(Slug-Ft ) 

Harmonic 

.565 x 10“ 2 

226. 006 


Internal 

.2801 x 10" 4 

1. 11413 


External 

.1755 x 10“ 4 

. . i 

.6938 



The mass moment of inertia of the balance beam and input 
pulley were calculated to complete the information necessary 
for energy balance and dynamic torque determinations. 

Figures IV-15a through IV-15f show the dynamic data for 
all drives. 


4) Conclusions 


Harmonic Drive - This drive requires approximately 
307o additional torque be applied over actual output torque to 
overcome the static friction of the drive. This value applies 
regardless of the output load. At zero output load, 50 ft- lbs 
(output value) was required to initially move the drive. 
Periodic drag was noted at approximately every 15° of input 
shaft rotation. This drag could be referred to as cogging. 

As the drive was accelerated, the cogging effect was not as 
noticeable. 

There was no detectable backlash associated with this 
drive. The spring deflection (windup) of the drive was sub- 
stantial and is a serious characteristic to consider for its 
effect on the control system. At 1200 ft- lbs output torque 
applied, the input shaft turned approximately 235° before 
movement of the output shaft was detected. An angle of 235° 
at the input shaft represents 1° 10* windup at the output 
shaft. Part of this windup can be eliminated by increasing 
the diameter of the output shaft but the majority would remain 
as inherent to this type of drive. It has been proposed also 
that 507> reduction in windup could be accomplished by using a 
3 lobe cam instead 2; and some additional lessening of windup 
by tightening cam fit. 
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Figure XV- 15a Harmonic Drive-Dynamic Torque Losses 
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Figure IV- I5b External Drive-Dynamic Torque Losses 



Figure IV- 15c Internal Gear Drive-Dynamic Torque Losses 
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Figure IV-15d Harmonic Drive-Torque Losses 
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Figure IV-15e External Drive-Friction and Inertia Torque Losses 
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Figure IV-15f Internal Gear Drive-Torque Losses 
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The drive efficiency based on work-in vs work-out in the 
dynamic range is low in the low velocity range where this 
drive will be operated. With higher velocities, the efficiency 
improves to the 80 to 90% range. 

At the higher velocities, frictional torque of the drive 
diminishes substantially from the static breakaway value. How- 
ever, due to the high moment of inertia, torque to accelerate 
the gearing is high. 

External Drive - The static breakaway friction of 
this drive was over 407> less than the harmonic drive. No cog- 
ging was observed. Torsional deflection at maximum output tor- 
que was 115 at the input shaft or 35 arc minutes at the output 
shaft. An evaluation of deflection shows that the majority of 
this is attributable to bearing deflection and looseness. Close 
tolerance, good quality angular contact or tapered bearings 
can improve this situation. 

Backlash in this drive varied from 1.8 to 3.0 arc minutes 
at the output shaft.' This var iatiton is caused by gear eccen- 
tricities and bearing deflection. The drive was designed to 
allow for unlimited adjustment of the output gear to the pin- 
ion and minor adjustments in the other gear centers. During 
final assembly it was noted that the output spur gear was 
substantially eccentric. Backlash could be adjusted to a 
small angle only at one point on the gear. 


Dynamic torque losses vary from 5% of the output torque 
at 250 ft-lbs to 107> at 1200 ft-lbs output torque. This is 
substantially less than the 207o figure for the Harmonic Drive 
at high and low output torques. 

This drive exhibited excellent backdrivability character- 
istics. Static breakaway efficiencies were nearly as good 
during backdr iving as forward driving. No cogging or draggy 
spots were noted. 

Internal Drive - Improvement in the static and 
dynamic friction was noted over the external drive. Back- 
drive efficiencies were as good as the forward efficiencies. 
Backlash is 1.8 arc minutes at the output shaft (measured 
at the completion of the load tests). Torsional windup of 
about 15 arc minutes, less than half the external drive, was 
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the most noted difference over the external drive. As with the 
external drive, the use of close tolerance angular contact 
bearings will reduce this deflection even more. No cogging 
was noted. 

The results of this test program clearly suggest that the 
double drive, internal spur gear system is the best choice of 
drive for the shoulder joint (and probably for all the joints) 
of the manipulator arm. In addition to the operational per- 
formance advantages of this drive, it can be packaged more 
compactly than the external spur gear system. The torque 
motor can easily be located within the drive housing. 

3. Motor-Gear Ratio Selection Considerations 

a. Introduction - To optimize the selection of the motor 
and gear ratio to be used at the shoulder and elbow gimbals of 
the 1-G manipulator, the following operational criteria were 
considered: 1. Power, 2, Speed, 3, Duty Cycle, 4. Friction, 

5. Weight, and 6. Inertia. Each requirement is briefly disc- 
cussed and curves are presented that depict the effect the re- 
quirement has on the motor-gear ratio selection. The included 
curves are drawn for 1200 ft lb (shoulder) and 650 ft lb (elbow) 
gear assemblies and consist of points that represent various In- 
land and Magtech DC torque motors that give, when combined with 
the indicated gear ratio, the desired stall torque value. Since 
the curves were generated from existing motor catalogue data, 
they can be used only to indicate general trends, and thus the 
effects a particular parameter has on the gear ratio selection 
cannot be definitely defined. The plotted data can be used only 
to bracket or give upper or lower bounds to the gear ratio that 
yields an acceptable motor-gear assembly. 


The shoulder gimbal is considered first, and based upon the 
arguments presented herein, a recommended gear ratio and torque 
motor selection is presented. A brake compatible with the 
chosen motor is indicated and a suitable tachometer generator 
is selected via considerations and graphs similar to those used 
to determine the acceptable motor-gear ratio. 

Curves applicable to the elbow gimbal are also presented 
and the elbow joint components are selected based upon results 
derived from the trends indicated by these curves. 
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b # Shoulder 1200 lb Joint Assembly 


1 # Power 


A General rule of thumb for the larger 
torque motors ( > 6 ft lbs) is to avoid output shaft powers 
greater than 1/2 the rated motor peak power. This precaution 
is a result of commutation problems that arise if shaft power 
exceeds 1/2 Pp. If it is desired to apply 1200 ft lbs to a 
shaft rotating at 0.07 rad/sec, then a servo motor with a 
peak power rating of (2)x (1200 ft lbs)x(0.07 rad/sec)x 

/1.3 watts v _ 

(___ ) - 218 watts must be used. 

ft lb/sec 

Examining the gear train vs peak power curves for Inland 
and Magtech motors, it is seen that a gear ratio of 65:1 or 
less should be used with a Magtech motor. 

It is also noticed from the curves that ratios of 70:1 
or less should not be used with Inland motors to avoid servos 
with excess power ratings. Likewise, ratios of 10:1 or less 
should be avoided with Magtech motors to illiminate over de- 
signing. 

Conclus ions : Gear Train vs Peak Power curves indicate a 

general trend that reveals the 
for the two motors considered: 

1. Inland 

2, Magtech 

2. Speed 

For the 1200 ft lb gear assembly under con- 
sideration, the maximum desired no load speed is 0.07 rad/sec. 
From the graphs of gear train vs output speed for the Inland 
and Magtech motors, it is seen that all gear ratios of 90:1 
or less satisfy the speed requirement for Inland motors, and 
ratios of 77:1 or less satisfy the requirement for Magtech 
motors . 

Note from the curves that as the gear ratio decreases, 
the output speed increases. At first thought, one might 
think that a lower gear ratio limit must be specified to avoid 
overdesign; this is, of course, true, but the limit must be 
derived from power considerations and not solely from the gear 
train vs speed curves. 


following gear ratio bounds 

70:1^ ► 170:1 

10:1** — — ► 65:1 
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Conclusion: 


1. Inland j£ 90: I 

2, Magtech <77:1 

3 . Duty Cycle 

Since a duty cycle criteria has not been established for 
the 1-G simulator, to meet any future duty cycle requirement 
a near 100% full torque on time must be desiged for. 

A general trend for D.C. servo motors is - the larger the 
motor the higher the duty cycle. 

Thus, motors of at least a certain size must be selected 
to allow for even the most stringent operating conditions. Upon 
examining the duty cycle vs motor size curves, there appears 
to be a great difference between the duty cycles for Inland 
and Magtech. 

This is actually not the case since the two companies differ 
in their laboratory procedures for measuring motor heat dissi- 
pation. Magtech claims to arrive at their °C/watt ultimate 
temperature rise figures with the motor placed in a typical 
installation configuration, while Inland makes temperature 
measurements with the motor attached to no heat sink metal 
such as a shaft and housing. 


Since the Magtech values are quoted to be "typical", it is 
assumed that Inland motors will yield comparable values under 
similar test conditions. 

Examining the Magtach duty cycle curve, it appears that a 
motor capable of 12 ft lbs stall torque or greater should be 
selected to assure a 100% or greater duty cycle. This require- 
ment results in a gear train ratio of 100:1 or less for a 1200 
ft lb gear assembly. 

Conclusion : 

1. Magtech 25 100: 1 
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4. Friction 


Friction in D.C. torque motors has two sources: 1* brush 

commutator friction and 2. magnetic retarding torques (such as 
hysteresis drag and cogging). Brush drag accounts for 20-40% 
of the total friction with magnetic effects contributing the 
other 60-80%. Mag tech motors have slightly higher magnetic 
friction which is a result of their design philosophy to build 
motors with a high torque to weight ratio . 

Observing the Gear Train vs Friction curves for a 1200 
ft lb gear assembly, it is seen that friction levels at the 
output gear shaft are fairly independent of gear ratio for 
rat ios between 4 : 1 and 90:1. 

Although as stated above, Magtech does have higher friction 
levels, no general trand from either curve is noticed and 
therefore no conclusions will be drawn on restrictions as 
to gear ratio. 


5. Weight 


Although the larger the torque motor the greater the weight 
is an obvious fact; when the weight of motor and gear train 
are considered together for a 12G0 ft lb gear assembly, a 
definite trend developes. As noticed from the Gear Train vs 
Weight curves for Magtech and Inland motors, gear ratios 
greater than 35:1 and less than 200:1 produce a total gear 
assembly weight that is almost gear ratio invariant. Below a 
35:1 ratio the total assembly weight starts to increase rapidly. 
These two facts are a consequence of gear weight dominancy 
for high gear ratios and motor weight dominancy for low gear 
ratios. The former fact of a dominant gear weight yielding a 
constant total assembly weight is a result of the large output 
gear weight being fairly independent of the gear ratio for 
ratios between 35:1 and 200:1 for Inland and 55:1 and 200; 1 for 
Magtech. 

Conclusion : 

1. Magtech S: 55:1 

2. Inland :S:55:1 

6. Inertia 


The inertia of the motor rotor is reflected to the output 
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gear shaft as a function of the square of the associated gear 
ratio. For a 1200 ft lb gear assembly, it is seen from the 
Gear Train vs Inertia curves that the reflected rotor inertia 
for Inland and Magtech motors does not increase rapidly as the 
gear ratio is increased from 30: 1 to 90:1, but remains fairly 
constant due to the smaller rotor inertias for the smaller 
motors. At first this result would seem to indicate that a gear 
ratio between 30:1 and 90:1 would be optimal from the inertia 
standpoint. Although this is partially true, the value of 
this optimization fades when the reflected motor inertia is 
compared with the load inertia. For the 1200 ft lb shoulder 
gear assembly under consideration, the unlaoded arm^ inertia 
abo^t the shoulder joint is approximately 1.03 x 10 ft l|g 
sec and £he loaded arm inertia is approximately 3.2 x 10 
ft lb sec . When these numbers are compared with the average 
reflected motor^inert ia for gear ratios between 30:1 and 90:1 
of 70 ft lb sec , it is realized that even the unloaded arm 
presents inertia loads two orders of magnitude greater than 
the reflected motor inertia. Therefore, any optimization re- 
striction on gear ratio values with respect to motor inertia 
is somewhat superficial. 

Conclusion : For gear ratios less than 90:1, reflected 

motor inertia is insiginif icant with respect to load inertias. 

7. Summary 


Criteria 

Indicated Gear Ratio Range 

Power 

Inland: 70: 1-**- 170: 1 

Magtech: 10: l-*-*"- 65:1 

Speed 

Inland: Less than 90:1 

Magtech: Less than 77:1 

Duty Cycle 

Inland: Less than 100; 1 

Magtech: Less than 100:1 

Friction 

No conclusions 

Weight 

Inland: Greater than 35 ;1 

Magtech: Greater than 55:1 

Inertia 

Inland: Less than 90:1 

Magtech: Less than 90:1 
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Speed (rad/ sec) Peak Power (watts) 
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Figure IV-19 Gear Ratio vs Friction, 1200 ft lb Gear Assembly 
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Attempting to average these results for all the criteria yields. 


Motor Brand 
Inland 
Mag tech 


Indicated Gear Ratio Range 
70:1-**- 90:1 
.55: W*-65.:.l 


It is reiterated once again these results are based only on 
trends and do not represent a hard fast rule. 

In an attempt to pick one brand of motor over the other, 
it is remembered that Mag tech has higher torque to weight 
ratios and Inland has lower static friction torque values. 
Since it was shown that for gear ratios greater than 55:1 
the gear weight was dominant, it appears that variations in 
motor weight are insignificant for this range of gear ratios. 
Thus it is suggested that Inland motors be selected on the 
basis of their providing somewhat lower magnetic cogging. 

Motor, Gear Selection 

Using the above information as a guide, the following 
motor, gear selection is offered as a candidate for 
one of the 1200 ft lb shoulder joints of the 1-G simulator. 

Gear Ratio : 85.7:1 

D.C. Xorque Motor : Inland 1-5745 


No load speed; 

14 rad/ sec 

Motor 

friction: 

0.15 f t lbs 

Motor 

inertia; 

2 

0. 01 ft lbs sec 

Motor 

peak power; 

.274 watts 

Motor 

temp, rise: 

1. 3 "C/watt 

Motor 

weight: 

15 lbs 

Motor 

constant: 

0.88 ft lb/ watt 

it 

Motor 

power rate; 

19600 ft lbs /sec 2 

OD: 


7. 2 inches 

ID; 


3. 95 inches 


IV- 4 2 



Mot or -Gear Assembly ; 


Stall torque: 1200 ft lbs 

Max, output speeds 0,16 rad/ sec 
Reflected friction: 12,8 ft lbs 

r 

Reflected inertia; 73,4 ft lbs sec" 
Total weight: 124 lbs 

Brake; Simp la trol PMB-103 

Holding torque: 16,6 ft lbs 

Weight: 3.8 lbs 


c. Tachometer Generator Considerations - Upon comparing 
Inland and Magtech tachometer generators there appears to be 
no outstanding advantage of one brand over the other. Although 
only Magtech generators are considered below due to a more ex- 
tensive Magtech tach generator catalogue, this by no means 
implies that an Inland product would not be suitable. 


The various tach generator parameters discussed below are 
compared as a function of a maximum generator speed since this 
is the most well defined parameter in the selection process. 

For the motor-gear train selected previously, the no load 
motor speed is 14 rad/sec . Tach generators having maximum 
speed capabilities slightly less and slightly greater than 
this value are considered to reveal general trends in the various 
parameters . 

1) Sensitivity - It is seen from the Max. Speed vs 
Sensitivity curve that the generator sensitivity rises sharply 
for max. speeds below 15 rad/sec. Since a high sensitivity 

is desirable, it is concluded that a tach generator with the 
lowest possible maximum speed that is compatible with the 
torque motor selection should be used. 

2) Weight - From the Max. Speed vs Weight curve the 
general trend indicates the lower the maximum speed the greater 
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Weight (ibs) 





Figure IV- 24 Maximum Speed vs Ripple 



Max. Speed (rad /sec) 

Figure IV-25 Maximum Speed vs Breakaway Torque 
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the weight. This seems to indicate a high speed generator 
should be used to minimize weight, although this is true to 
some extent, the tach weight is negligible compared to the 
total gear assembly weight, and therefore weight conservation 
is not a dominant factor for generator selection. 

3) Ripple - The Max. Speed vs Ripple curve indicates 
that ripple varies only between 5 to 7% for max. speed values 
between 8 and 20 rad/sec. Therefore % ripple does not appear 
to be a limiting factor. 

d. Breakaway Torque - The Max. Speed vs Breakaway Torque 
curve reveals that generally higher speed tachs have a lower 
static friction value. Although this seems to indicate a 
high speed generator should be selected with respect to 
friction torque, it is noted that breakaway torque differs 
only by 0.025 ft lbs for speed ranges between 8 and 20 rad/sec 
and the total friction values range only between 0.02 and 0.047 
ft lbs. These values compared with a motor friction of 0.14 
ft lbs are small, and therefore breakaway torque does not con- 
stitute a major parameter to oe optimized. 


4 . Summary 

From the above discussion, it is believed that sensitivity 
is the dominant parameter in the selection of a tachometer 
generator. Since sensitivity varies inversely with maximum 
speed, a generator should be picked that has a max. speed com- 
patible with the selected torque motor no load speed. As an 
example, and this is by no means unique, of a tachometer that 
meets the above criteria, the following selection is offered. 


Tachometer Generator: 

Magtech 3730B-134 

Max. Speed: 

15 rad/ sec 

Sensitivity: 

5.0 V/ rad/ sec 

Ripple: 

7 % 

Breakaway Torque: 

0.021 ft lbs 

Moment of Inertia 

: 0.00031 ft lb sec 

Weight: 

2.06 lbs 

OD: 

3. 73 inches 

ID; 

1. 34 inches 
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Elbow 650 ft lb Joint Assembly - The elbow gimbal com- 
ponents were chosen in the same fashion as were those of the 
shoulder. The following curves show the relationship between 
gear ratio and: 

1. Power 

2. Speed 

3. Duty Cycle 

4. Friction 

5. Weight 

6. Inertia 

7. Motor outside diameter 


The trends of these curves indicate the following criteria - 
gear ratio relationships. 


Criteria 

Indicated Gear Ratio Range 

. Power 

Inland: less than 144; 1 

Magtech: less than 35:1 

, Speed 

Inland* less than 100; 1 
Magtech: less than 40:1 

. Duty Cycle 

Inland: no conclusion 

Magtech: no conclusion 

. Friction 

Inland: less than 94:1 

Magtech: less than 86:1 

, Weight 

Inland: greater than 35:1 

Magtech: greater than 35:1 

. Inertia 

Inland: less than 144:1 

Magtech: less than 100:1 

. Motor Outside 

Diameter 

Inland: greater than 44:1 

Magtech: greater than 40:1 
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Weight (lbs) 




Gear Ratio 

Figure IV-31 Gear Ratio vs Reflected Inertia, 650 ft lb Gear Train 
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figure IV-32 Gear Ratio vs O.D., 650 ft lb Gear Assembly 


Attempting to average these results for all the criteria 
yields. 

Motor Mfg. Indicated Gear Ratio Range 

Inland 44 . ^ 

Magtech No obvious conclusion 

Once again selecting an Inland motor in the above indicated 
range results in the following suggested components. 


Gear Ratio : 46. 4; 1 

D.C. Torque Motor ; Inland T-5745 

Motor-Gear Assembly ; 

Stall torque; 650 ft lbs 
Max. output speed: 0.3 rad/sec 

Reflected friction: 6 . 9 ft lbs 

2 

Reflected Inertia; 21.5 ft lbs sec 
Total weight: 124 lbs 


As revealed above, the same motor was selected for both 
shoulder and elbow joints; thus, the same break and tacho- 
meter generator can be used for both joints. Reiterating, 
these two elements are: 

Brake : Simplatrol PMB-103 

Tachometer Generator: Magtech 3730B-134 
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4. Joint Design for AMS 


This section discusses the final design approach for three 
joints and some of the included components. The design arrange- 
ments are the result of analyzing many previous designs, the 
limiting envelopes required, directed toward weight opti- 
mization, stresses and loads in important members, and of 
course the breadboard tests and technology studies of motor/ 
gearing combinations. Assembly sequence is also a very im- 
portant factor in considering the arrangement. 

Each joint contains a DC servo motor, DC fail-safe magneti- 
cally operated brake, tachometer generator, all preferably on 
a common shaft, a potentiometer, gearing as the torque multi- 
pier, yoke type hinging to provide maximum load carrying bear- 
ing support, and precision bearings located biaxially (at end 
of shafts - non-cantilevered loads) wherever space permits. 


Every effort has been made to, standardize on components 
wherever possible to reduce costs, to simplify maintenance 
and to minimize adverse effects on the control system. 

Addition weight optimization will be necessary in the 
detail component design. Aluminum castings should be con- 
sidered for the large housings where some machining areas 
may be difficult or impossible for reducing weight. 

For the final AMS and SAMS gears a full hardness would 
be recommended. This may require grinding after heat treat 
if it is determined that there would be significant distortion 
of critical tolerances. It would reduce costs if grinding 
could be avoided. Shaping, hobbing and/or shaving may be 
sufficient. A hardness of from RC38 to RC45 should also pro- 
vide good tooth wear characteristics for the type of service 
expected. 

The three joints preliminarily designed are the shoulder 
pitch and roll and elbow yaw. These are discussed in the 
following paragraphs. 

Shoulder Pitch - The design of this drive is shown on 
Figure IV-33. It incorporates the type of internal gearing 
system proven by the tests, however, in a smaller packaging 
arrangement. The gearing ratio was selected at approximately 
96:1 which when used with the proper motor 14 ft- lb produces 
an optimum design capable of providing the required 1200 ft. lb 
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Figure IV- 33 AMS Shoulder Pitch Joint Assembly 




output torque plus losses. (See Section A. 3 ‘for gear train 
ratio and motor selection.) 

The selected motor Inland T5945 weighs 16 lbs and will 
provide 14 lb ft at stall. The armature is held onto the 
shaft by end clamping (standard practice) and will have a 
partial aluminum support for lighter weight. Provision is 
made in the housing for wire routing to a common penetration. 
Particular attention has been given for the provision of proper 
sequence of field "keeper" removal to prevent magnet damage. 

Tach generator (Magnetic Technology No. 7000-065) install- 
ation and support is similar to the motor however somewhat 
larger and thinner to enable assembly within the envelope. 

Both tachometer generator and motor will have the required non- 
magnetic material clearances of approximately 0.25 inches. 

The fail-safe brake that fulfills the requirement is a 
Simplatrol PMB103. This will provide a braking torque of 
slightly greater than the motor stall torque. This type has 
been used previously in the MMC test articles. Many others 
similar in size and capacities are available. There was some 
speculation concerning the use of a new type of fail-safe 
brake, from the same company, that can be pulse operated to 
open and close, thereby eliminating "operational period" power 
consumption. However, for simulator use the standard brake 
was selected. For space use the pulse operated system (nearly 
the same size but requiring external electronics) should be 
investigated further. Axial alignment of the brake is rela- 
tively unimportant except for dynamic balancing problems, 
therefore, it can be placed in a cantilevered mode if nec- 
essary and also driven through a coupling. 

The gearing is designed using high strength SAE 4340 steel 
at a hardness of RC38 to RC45 for strength and wear charac- 
teristics necessary for a simulator, however, also sufficiently 
capable for space use. Precision tolerances in housings, bear- 
ings and gearing (and shafting) will permit backlashes on the 
order of .002 in. to be fully realizable. Selected gear 
pitches: 1st mesh: 24; 2nd mesh: 16; 3rd mesh: 10 will provide 

smooth torque transmittal, yet be sufficiently strong for 
small impact loads, and continuous duty at rated loads. 

The internal ring gear is the identical pitch as that 
used in the test apparatus. Tooth finishes should be held 
to 30 rms for best wear. 
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Wherever possible multiple gears should be made on one 
shaft with spacing only sufficient for tooth cutting relief 
for shaping, hobbing or grinding tools. One of our gear/ 
pinion combinations does require a two piece fabrication due 
primarily as an aid in fitting in the dual output system to 
allow for proper orientation of teeth throughout. For this 
gear it is planned that the gears be machined separately, 
however, assembled and pinned (riveted) together for posi- 
tioning and holding in shear. If the fabrication or develop- 
ment proves the necessity for gear grinding (warpage from heat 
treat) the other dual gear/pinions could also be fabricated 
in two pieces. 

Access to components and isolation of electrical com- 
ponents from gearing is desirable although not mandatory. 

This reasoning has also been imposed wherever practicable. 

The bearings will be the permanently lubricated double 
shielded type. It is recommended that a dry lubricant baked, 
burnished, (or possibly impregnated type) be used, and a thin 
application of a lubriplate or silicone grease also be con- 
sidered. Wherever grease may be thrown out double shields 
will be provided. This situation is unlikely because of the 
slow speeds involved. Care must be exercised to prevent oil 
film build-up on brushes and brake faces in particular. 

Bearings selected for this design are readily available. 

One promising approach selected is extensive use of double 
row angular contact bearings which help on alignment and pre- 
load. Other precision bearings (angular contact) could also 
be acceptable. Joint housings will be high strength aluminum 
such as 6061 T-6 or equivalent. 

No internal mechanical stops for rotation are required for 
this joint. The motor provides the prime stop force via the 
control system; fail-safe braking provides stopping forces 
in the event of power loss. 

This joint was designed to obtain a packaging so that it 
could also be used for the shoulder yaw and so that it would 
be applicable to the space version. 

Shoulder Roll - Figure IV- 34 shows a layout for this joint. 
The design applies specifically to the AMS because of the 
necessity of including the counterbalance bar scheme (See 
Section C) within the tubing. For the space version it would 
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be intended that a roll design would be incorporated within 
the tube. 

The AMS roll joint is of utmost simplicity. Easy backdrive- 
ability is not a requirement, therefore, a worm drive was 
selected. This offers two advantages: a) a very high single 

mesh ratio and b) deletion of a holding fail-safe brake be- 
cause of the inherent high friction capability of 
a properly designed worm gearing system. 

It is planned that the 14 ft lb DC torque motor used in 
the shoulder pitch be used here for commonality. Certainly 
this represents a maximum size and could be reduced if nec- 
essary. However, for the roll joint of the AMS configuration, 
weight is not critical. Counterbalancing has been considered 
and is easily accommodated in a symmetrical envelope if nec- 
essary. Added inertia is not significant compared to the main 
arm segments. 


Elbow Yaw - The same motor Inland T-5745 as those in the 
shoulder joints used here with a 53:1 gear ratio, after 
counterbalancing mechanisms and gearing friction losses 
are accounted for, we have (with some margin) the required 
650 ft lbs torque. Use of gearing and counterbalancing bread- 
board test data provided guidance in determining conservative 
allowances for frictional losses here. 

Figure IV-35 is a layout of the elbow joint. The counter- 
balancing mechanism crankshaft disks (See Section C), driven 
by the connecting bars are shown in dashed lines. These 
occupy considerable envelope space, even though minimized in 
size, and caused the resultant gearing arrangement with the 
ring gear drive in the yoke. It was desirable to provide a 
dual gear drive here as in the breadboard, however, the counter- 
balancing mechanism prevented this and a compromise was made 
-Using only one drive pinion. Several gearing and bearing 
arrangements were investigated. The resultant design appeared 
best because of minimal housing extension and its attendant 
lower weight. Also the desirability of having the motor and 
tachometer generator and motor drive pinion on the same shaft 
with the brake was achieved. 

The ring gear used in the yoke drive is slightly larger 
than that used for the shoulder, however, it does allow use of 
a larger pinion for single drive tooth strength, and with a 
larger number of pinion teeth undercutting is avoided. Back- 
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driving will be very easy with the 53; 1 ratio. Dust protection 
can be provided by a plastic or rubber lip. Normally (for 
space version) all gearing would be internal to the main 
housing. 

All bearings can easily handle the loads while retaining 
the necessary alignment with minimal deflections. Double 
sealed bearings will be used which should be good for the 
life of the simulator. Preloading will also be employed either 
externally or in double row angular contact. 

The tachometer generator selected is Magnetic Technology 
3730 B-134 the same as that used for the shoulder roll. 


A Simplatrol fail-safe brake model PMB-103, (identical 
to that specified for the Shoulder Pitch) is provided. This 
will provide 16.7 ft-lb which is slightly greater than stall 
torque of the motor. 

Generally the yoke/hinge configuration and envelope is 
applicable to both the AMS and SAMS except for the elonga- 
tion of the housing beyond the hinge centerline to contain 
the motor, tach generator brake and part of the gearing. 

The yoke/hinge allows articulation from approximately -2° 
to +164° minimum. Yoke design shown here has been partially 
enclosed with the angled flange that provides added joint 
stiffness and strength. 
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B. COUNTERBALANCE ANALYSIS AND OPTIMIZATION 


A prerequisite to realistic AMS operation in a I-g envir- 
onment is some means by which the torques about the AMS joints, 
due to gravitational forces, can be nullified. One way to 
accomplish this is to extend the upper arm back past the 
shoulder joint for some distance and attaching an articulated 
counterweight at the end of this extension (see Figure IV- 36), 


Upper Arm 


Lower Arm 



°l{_ 


Articulated 
Counterweight 


T 

Elbow Joint 
Shoulder Joint 


Figure IV- 36 Articulated Counterbalance Concept 

The term articulated implies that the counterweight is physically 
connected to the elbow joint in such a way that the orientation 
of the counterweight relative to the upper arm is identical to 
the orientation of the lower arm relative to the upper arm. (the 
angle, a, in Figure IV- 36), A detailed discussion of how one 
actually achieves such articulation is contained in Section C 
of th is chapter , 

It will be shown in what follows that, by proper selection 
of the counterbalance inertia properties and geometry, it is 
possible to negate the gravitational torques about the shoulder 
and elbow of the AMS, simultaneously, regardless of AMS orienta- 
tion (neglecting perturbations due to changes in wrist orienta- 
tion). 
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It will become apparent in the sequel that there are an 
infinity of counterbalance geometry and inertia combinations 
that satisfy the counterbalance equations. It is therefore 
necessary to further investigate the details of the AMS design 
in order to arrive at a meaningful criterion for selection 
of counterbalance inertia properties and geometry. One means 
of selection can be found by examining the increase in shoulder 
pitch moment of inertia for each of the multitude of counter- 
balance possibilities; for, although the gravitational torques 
are cancelled in each case, the shoulder and elbow motors are 
required to drive the additional counterbalance inertia. Thus, 
it would seem desirable to choose the counterbalance mass and 
geometry that minimizes the increase in inertia. The necessary 
equations and corresponding digital computer program to accom- 
plish this task are described below along with results for a 
range of AMS design data. Finally, some conclusions are drawn 
about the counterbalance design. 

1, Counterbalance Equations 

We begin by assuming there are no unbalanced gravity 
forces on the payload or the support structure (i.e., it is 
assumed that both of these bodies are supported by the floor). 
For this reason, one need only consider counterbalancing the 
unloaded AMS. To further simplify matters, we assume the wrist 
does not require counterbalancing and therefore lump the mass 
of the wrist at the end of the lower arm. 

The foregoing assumptions result in a reduction of the six 
body model shown in Figure A-l (see Appendix A) to the four 
body model shown in Figure IV-37. It is noted that the gravity 
vector, g, is assumed parallel to e ^y 

Now the counterbalance design philosophy is to choose the 
mass properties of body 1 and the location of hinge 1 (see 
Figure IV-37) in such a way that the torque motors at hinges 
2 and 3 need not counteract any gravity torques, regardless 
of AMS orientation. 

The necessary counterbalance relations can be obtained 
from Equations (A-l) - (A-12) in Appendix A. _For the static 
case and with the gravity vector parallel to e fi „, these 
equations become (for the four bodies shown in Figure IV-37). 
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where F^ in Eq. (IV-4) represents the force of the floor on 
the support structure. Sglving Eqs. (A- 7) - (A- 9) (See 
Appendix A) for T-^ H , T 33 » and , and using the above 
expressions for the hinge forces, one is left with 
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Now it is assumed that the orientation of body 1 relative to 
body 2 is identical to that of body 3 relative to body 2 and 
it is further assumed that 
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Equation (IV- 8) reflect the assumption that the joints lie 
on the centerlines of the tubes comprising the lower and 
upper arm segments. 

Since the motor at joint 3 must drive both bodies 1 and 
3, the counterbalance conditions can be written 



+ T H 

33 


= 0 
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Substituting from Eq. (IV-8) into (IV-5) and (IV-6), Equation 
(IV- 9) can be written 


C m l S H 1X - m 3 g H 33 ) e 31 x e &3 0 

which will be satisfied regardless of the AMS orientation if 
one requires 
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Similarly, Eq. (IV-10) can be written 

S^ll ' m 3 SH 33 )5 31 x 5 63 + [ m l g ®21 * H 22 ) * m 3 g ®23 + H 2 2 > 

- m 2 SH 22 J S 2l * 5 63 - 0 (IV-12) 

From Eq, (IV- 11) It follows that the first term in Eq, (IV-12) 
vanishes, and therefore Eq. (IV-12) will be satisfied if, 


m l®21 ' H 22^ 


”3®23 + H 22> 


” 2 H 22 = ° 


(IV- 13) 


Thus, Equations (IV- 11) and (IV- 13) are the necessary condi- 
tions for the AMS to be counterbalanced in any orientation. 


It is more meaningful to write Eqa. (IV-12) and (IV- 13) 
in terms of the counterbalanced AMS design quantities shown 
in Figure IV-38. These quantities are as follows: L , 

is the distance from the counterbalance elbow (CBE) to tne 


mass center of the counterbalance lower arm (CBLA) ; M CRLA 
is the mass of CBLA, and M^.^ is the mass of the CBE; 

S!\ 


h 

an 


CBE 

is the length of the counterbalance upper arm (CBUA) , 
'BUA t * ie mass the CBUA; L nA is the length of the 


upper arm (UA) and I s the mass of the UA; is the mass 
of the elbow and M^ is the mass of the lower arm; is 
the length of the lower arm and M^ is the mass of the wrist 
(assumed to be concentrated at the wrist joint). In terms 
of this notation, Eqs. (IV- 11) and (IV- 13) can be written 


L LA 

M CBLA L CBLA " *\a + 2 (IV- 14) 

^CBLA + M CBE + JCBUA^ L CBUA = ^UA + “e + “iA + V ^JA ^ IV " 15 ^ 
2 2 
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Figure IV-38 Counterbalanced AMS 


Equations (IV- 14) and (IV- 15) are the so-called counter- 
balance equations that must be satisfied for cancellation of 
the gravity torques at the shoulder at elbow joints. It is 
noted that these two equations contain three unknowns: 

L CBLA 5 anc * ^CBUA* mass > M CBUA> can determined from 15 

L and the remaining terms canbe obtained from preliminary 

design data. Thus, Eqs. (IV- 14) and (IV- 15) can be used to 
determine L and once 

these equations offer no clue as 

M, 


[ CBIA ^ as ^ een selected, but 
to the proper selection of 


cbia: 


What is needed then is a third relationship that will 


pinpoint the selection of M C gLA* 


Selection Criterion for the Counterbalance Mass 


The necessary third equation to supplement Eqs. (IV- 14) 
and (IV-15) is obtained in what follows by minimizing an ex- 
pression for the increase in shoulder pitch moment of inertia 
caused by the addition of the counterbalance mechanism. Toward 
this end, the counterbalanced AMS in Figure IV- 38 is idealized 
as shown in Figure IV- 39. 


The lower arm is taken to be a thin-walled tube of diameter 
D LA’ t ^^ c ^ cness length and density The wrist 

is modelled as a concentrated mass WL. and moment of inertia 
1^ located at the end of the lower arm. 

The upper arm is also a thin-walled tube of diameter D ..., 

thickness t^, length and density P The elbow motor, 

gear train, etc, are all lumped together in a concentrated 

mass M .and moment of inertia I located at the end of the 

upper arm. In one of the counterbalance schemes (see Section 

C of Chapter IV), several rods pass through the hollow upper 

arm connecting the lower arm to the CBIA. These rods are 

modelled as a single solid cylinder of diameter D^, density 

P and length L , Later, if rods are not used, p can be 
UA L*K. 

taken as zero* 

The counterbalance upper arm (CBUA) is simply an extension 
of the upper arm model over a length h c _„. , The hardware 
connecting the CBUA to the CBLA is accounted for by a con- 
centrated mass and moment of inertia I^g. 

The CBLA is modelled as two solid cylinders of radius 
r CBlA! height h rRT . , and density P crl a. The distance from 
tnecBE to the mass center of the CBLA (the axis of the two 
cylinders) is called 
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Finally, three rectangular plates are used to represent 
the shoulder yoke. Two of the plates are of length Ly, width 
Wy, and thickness t , The back plate is of height H and of 
thickness t^. All Xf the plates have a density p^. ^ 

The maximum increase in shoulder pitch moment of inertia 
due to the counterbalance mechanism occurs when the AMS is 
fully extended. Only the contribution of the CBLA, CBUA, 
and the yoke to the increase in moment of inertia need be 
considered. The connecting rods in the upper arm represent 
an increase in moment of inertia, but their contribution does 
not depend on the mass, and hence need not be considered 

when minimizing the increase in shoulder moment of inertia. 

The functional dependence of the other contributions (on 
will become clear in what follows. 


The moment of inertia of the CBLA about the shoulder pitch 


axis. 


CBLA’ 


is computed as follows 


I CBLA M CBLA^ L CBLA + L CBUA^ + M CBLA r CBLA 

2 

r CBLA iS determined from M CBLA’ h CBLA 
follows 


2 


and 


(IV- 16) 


CBLA 


as 


r CBLA 


M 


CBLA 


1/2 


27rh CBLA P CBLA 


(IV- 17) 


The moment of inertia of the CBUA about the shoulder pitch 
axis, I cbuA > can he written 


( 2 2 

5jA + jSB2£) f „ (;CR + “CBUA 
8 12 / uA2 1 

2 




CBUA 


+ ^UAl + ^UA2^ 4 + I CBE + M CBE L CBUA (IV- 18) 
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(IV- 19) 


where *VAl 


is the mass of the hollow tube; 


^UAl " T °UA fc UA L CBUA P UA 


and My ^2 i- s the mass of the connecting rods 


w d cr l cbua P CR 
^UA2 4 


(IV- 20) 


In computing the moment of inertia of the yoke, the shoulder 
pitch axis is assumed to pass through the center of the back 
plate, parallel to the edge of length Ly. The pitch moment 
of inertia of the yoke about the shoulder pitch axis is then 


I =2M 1 W + M 0 

y yl y y 2 


where M - is the mass of 

yi 


;0? + w 2 ) 

y y 


(IV- 21) 


one of the horizontal plates: 



P W L t 

y y y y 


(IV- 22) 


and M _ is the mass of the back plate: 

y 2 

M = P W H t 

y 2 y y y y 


(IV- 2 3) 


Now the minimum allowable dimensions of the yoke, Hy and Ly, 
depend on the size of the CBLA and CBUA, In particular, when 
the shoulder yaw angle and elbow yaw angle are both 90°, the 
height, Hy, of the yoke must be large enough to avoid any 
contact between the CBLA and the yoke when the shoulder roll 
angle turns through 360°. This situation is shown in Figure 
IV-40(a). From the figure, it can be seen that 
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Figure IV-40 Yoke Size Constraints 



H 

y 



^CBLA + r CBLA^ 


^CBLA + 


UAn 


1/2 


(IV- 24) 


Similarly, the length Ly of the yoke must be long enough to 
avoid any contact with the CBLA when the AMS is fully extended 
and the shoulder yaw angle turns through + 90®, This condition 
is depicted in Figure lV-40(b). In this case, one can write 


Ly = r y2 = (L CBUA + L CBLA 


+ r CBLA? + 


^CBLA + 


UAv 


1/2 


(IV- 25) 


By means of Eqs, (IV-24) and (IV- 25) one is able to express 
the yoke moment of inertia (See Eq, (IV- 21)) in terms of the 
counterbalance dimensions (when W , t , and p are assigned 
reasonable values). It is now polsibie to wr?te the total 
increase in shoulder pitch moment of inertia, due to 

the counterbalance mechanism as 


I TOTAL " I CBLA + I CBUA + I y 


(IV- 26) 


Wh6re Wl V a *f Cti °" ° f M CBLA’ W’ h CBLA’ W* By 
solving Eqs, (IV- 14) and (IV- 15) for and ^CBUA’ res P ect ^ ve -'-y > 

and substituting into (IV- 26), we are left with an expression 
for I t0tal as a function of M GBLA and h CBLA only. In principal, 
one could set the appropriate partial derivatives equal to zero 
and obtain two equations for h^^ and that minimize I_q_^. 

Because Eqs, (IV- 14) and (IV- 15) have been used for and 

L , the solution, h and M . , of the two equations will 
015UA 015 .LA 015 LA 

be consistent with the counterbalance requirements. In practice, 

however, the resulting equations are highly nonlinear and hence 
not amenable to closed form solution. For this reason, a digital 
computer program has been developed to find those values of 

M CBLA and h CBLA that minimize I T0IAL* 
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3. Counterbalance Optimization Computer Program 


The digital computer program mentioned above is programmed 
with Eqs, (IV- 14) - (IV- 26). The input data consists of all 
of the quantities defined in Figure IV- 39 except M b Q BBA > 

r CBLA’ h CBLA.’ L CBUA’ H y’ and V ^ latter 3 uant itie s repre- 
sent the primary output of the- computer program. In this way, 

it is a simple matter to incorporate any design changes of 
the AMS and determine the new counterbalance and yoke specifi- 
cations. 


The increase in shoulder moment of inertia is minimized by 
incrementing M GBBA from some small value, and, for each value 
of M GBLA > finding the value of h CBLA that minimizes 
This process is continued until FL exceeds that value which 
minimizes I TOTAL in both M cblA and UBLA* 

By using this technique, plots of h CBIA , r^, L^, b GBUA » 

H , and L as functions of . for the optimum h„ v>T . value 

y’ y CBLA CBLA 

are obtained. In addition, plots are obtained of the percentage 

increase in shoulder (PISI) and elbow (PIEI) pitch moment of 
inertia defined by 


PISI = 


I TOTAL 

I +T 
LAS UAS 


x 100 


(IV- 2 7) 


PIEI = 


I CBLA 

I LAE 


x 100 


(IV- 28) 


where I Ac and I, tA o are the Pitch moments of inertia of the 
lower arm (Including the wrist) and upper arm (including the 
elbow), respectively, about the shoulder joint, and I^^, is 
the pitch moment of inertia of the lower arm and wrist about 
the elbow joint. 


In examining the total increase in shoulder moment of 
inertia, it is helpful to express this quantity as 

an equivalent increase in payload weight, WEQ, defined by 


WEQ 


I T0TAL 

V. + v 2 


32.174 


(IV- 2 9) 
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This quantity is also plotted as a function of for the 

optimum h CBLA . 

Finally, a quantity called CLEARANCE is plotted as a 


function of M, 


CBLA* 


This length measure is the distance between 


the extremity of the counterbalance and the center of the 
shoulder joint when the elbow yaw angle is 180°, This dis- 
tance is illustrated by Figure IV-41. It follows that any 
counterbalance solutions involving a negative or zero CLEARANCE 
are not practical. 



Figure IV-41 Counterbalance - Shoulder Clearance 

In the next section, the input data for the counterbalance 
computer program is described along with the results generated 
by this data. 

4. Input Data and Results 

With the exception of the yoke length and height and the 
geometry of the counterbalance lower arm, the quantities de- 
picted in Figure IV- 39 constitute the input data for the counter- 
balance optimization program. To generate the results that 
follow, values for these quantities were computed from pre- 
liminary design data, and these values are listed in Table IV-5. 
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Table IV-5 Input Data for Counterbalance Optimization Computer Program 


Lower Arm and Wrist 

°LA ~ 12 ia * * t LA = * 08 in > L LA 222 in * 

P LA = 3.11 x 10 3 slug/in 3 , = 1.55 slugs, 3^ = 1 x 10^ slug- in 2 
Upper Arm and Elbow 

°UA = 12 ia> fc UA " °* 18 in > L UA = 222 in * 

= 3.11 x 10 slug/in , D^ = 2.25 in, = 8.4 x 10 slug/in 3 

Mg = 2.5 slugs, Ig = 40.5 slug-in 2 

Counterbalance Upper Arm and Elbow 

M CBE = 1,55 slugs> • t CBE = 22,3 slu §“ in2 


Counterbalance Lower Arm 


-2 


CBLA 


,. 3 


1.27 x 10 slug/in 


Shoulder Yoke 

W y = 18 in > ty" 0,75 in, p « 3.11 x 10" 3 slug/in 3 
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The input data reflect aluminum arms and yoke, steel connect- 
ing rods, and a lead counterbalance weight. The wrist was 
assumed to weigh 50 lbs and the elbow joint, 80 lbs. 

The results of the computer program are shown in Figures 
IV-42 - IV-44. In each case, the dependent variables are 
plotted as functions of the counterbalance weight, 

Figure IV-42 illustrates the variation in counterbalance 
geometry with counterbalance weight. The lengths, L ^ 
and k are determined from Eqs. (IV- 14) and IV- 15) and 

therefore represent those values for which W will counter- 

CjBXjA, 

balance the upper and lower arm segments of the AMS. The 
values of h C BLA in Fi § ure *V-42 are those that result in the 
minimum increase in shoulder pitch moment of inertia for the 
corresponding value of W^gg^. Finally, the r £gg^ curve re- 
presents the radius of the counterbalance lower arm (lead 
cylinders) which are determined from Eq. (IV-17). 

The plots of WEQ, PISI, and PIEI in Figure IV-43 repre- 
sent the increase in moment of inertia corresponding to the 
values of h^, r^, L^, and shown in Figure 

IV-42. These quantities are defined by Eqs. (IV-27) - 
(IV- 29). The meaning of the quantity CLEARANCE shown in 
Figure IV-43 is illustrated in Figure IV-41. 

Finally, Figure IV- 44 depicts the length, L , and width, 

H , of the yoke corresponding to the counterbalance geometry 
sKown in Figure IV-42. 


The optimum counterbalance design is arrived at from 
Figures IV-43 and IV-44 in the following manner. Looking 
first at Figure IV-43, it can be seen that the increase in 
shoulder inertia, PISI, has a minimum value near 9000 Lbs. 

In addition to being unacceptably large, this value of 
results in a negative value of CLEARANCE (for convenience in 
plotting the data in Figure IV-43, negative values of CLEARANCE 
were plotted on the W^gg^ axis). A negative value of CLEARANCE 
implies that interference between the CBLA and the shoulder 
gimbal will occur when the elbow yaw angle approaches 180° 

(see Figure IV-41). Fortunately, the PISI curve is relatively 
flat for values of W^gg^ greater than 2000 Lbs. For this 
reason one can select a counterbalance weight, less than the 
optimum, without seriously changing the increase in shoulder 
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moment of inertia. Thus, the question remains as to what value 

of W one should choose. 

L.15LA 

In Figure IV -44 it can be seen that the yoke dimensions 
increase rapidly to the left of where the two curves inter- 
sect. For this reason, it was decided to choose that value 

of W„__ . for which H = L . For the ease at hand (50 lb 
CBLA ■ y y 

Wrist weight), this results in a counterbalance selection as 
shown in Figure IV-45. It is noted that, for the design shown 
in Figure IV-45, the total increase in shoulder pitch moment 
of inertia due to the 2900 Lb counterbalance weight, the 50 
in yoke, the connecting rods, etc. is equivalent to a 42 Lb 
weight at the end of the wrist. When compared to the larger 
payloads, this increase can be considered negligible. 

Throughout the foregoing investigation, it was felt that 
the counterbalance selection would be fairly sensitive to the 
wrist weight. For this reason, the procedure described above 
was repeated for wrist weights of 60, 70, 80, 90 and 100 Lbs. 

The resulting values for the yoke dimensions (H = L ) and 
the corresponding counterbalance weights are shown in Figure 
IV-46. From the figure, it can be seen that neither the 
counterbalance weight nor the yoke size are seriously affected 
by increases in wrist weight within the range shown. 

In conclusion, it should be noted that the results presented 
above are derived from preliminary design data and should • 
periodically be updated as the AMS design progresses. With 
the computer program described in Section 4, this merely entails 
changing the appropriate input data. 
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w CBLA (LbS) 

Figure IV -42 Counterbalance Dimensions 
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Figu re I V- 43 I ncrease in Moment of I nertia 
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Figure IV-45 Counterbalance Design Selection 


s Counterbalance Lower Arm Weight 
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Figure IV- 46 Counterbalance Selection vs Wrist Weight 


C. COUNTERBALANCE LINKAGE 


1. Introduction 


It was pointed out in the preceding section that, in order 
to counterbalance both the upper and lower arms simultaneously, 
the counterweight must pivot relative to the upper arm in con- 
cert with the rotation of the lower arm at the elbow (See Figure 
IV-36). What is needed, therefore, is some relatively rigid link- 
age (passing through the hollow upper arm) connecting the lower 
arm to the counterweight. In making such a connection, the grav- 
ity torque (of the lower arm and wrist) about the elbow will be 
transmitted to the counterweight joint where it can be nullified 
by proper design of the counterweight. In what follows, several 
techniques to accomplish the torque transmission are investi- 
gated , 

Primarily because of stiffness considerations, a multi-bar 
linkage was selected as the most satisfactory. A prototype of 
such a linkage was then constructed and a number of tests were 
conducted. Both a description of the hardware and the test re- 
sults are described in the sequel. 

Finally, drawing upon the results of the analyses and tests 
described above, a three bar system was selected as the recom- 
mended design. Several aspects of this design are included in 
the following discussion. 

2. Alternative Linkage Methods 

The general requirements for the counterbalance linkage are 
as follows: 

(1) Within the 12 inch diameter tube, 

(2) Anticipated counterbalancing maximum torque of 2000 
ft - lbs. , 

(3) High efficiency (low friction), especially breakaway, 

(4) Low inertia compared to the total arm, 

(5) High stiffness compared to tubes, 
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(6) Materials should comply with standard machining and 
tolerance capabilities. 

The alternatives considered are listed in Table IV-6, which 
gives a comparison of the important characteristics. Figure 
Figure IV-47 shows the concept of each. 

Single Cable - For simplicity this would be the ideal design, 
however, the restriction of pulley size by the AMS envelope and 
the cable manufacturer’s restriction of cable size for an 8 in. 
dia. With a torque of 2000 ft-lbs, this cable will have a ten- 
sion of 6000 lbs. If the cable’s diameter is increased to ac- 
commodate larger capacities, the bending stress will increase 
rapdily and will make the design less reliable and subject to 
flexing (bending) fatique in fewer cycles. 

Multi-Cable - This is a compromise design where the load 
will be distributed to several 5/32 in. or 3/16 in. dia. cables 
which can be operated at cable manufacturer’s suggested load level. 
This design is one of the more promising of the counterbalancing 
systems. A simple test setup of this system was built and data 
was taken at various loads. Figure IV-49 shows the setup which 
consisted of two stainless steel 7/32 in. dia. ( 7 x 19) strand- 
ed cables with pulleys. The pulleys had 9 in. pitch diameters. 

The goal was to obtain starting friction data including bearing 
friction and cable friction. The cable preloads were varied as 
well as the torque of the system the data below shows general 
characteristics of this setup. 

The data indicated that the preload on the cables has mini- 
mum effect on the starting friction. The curves (Figure IV-48) 
also show the bearing starting friction characteristics. The 
strain measurements taken from this setup were not consistent 
with each run but the magnitude of strain was measured. At 
rated 170 ft-lbs torque the elongation was in the order of .18 
in. to .20 in. The pulleys were 9 in. dia. The resultant strain 
was .003 in. / in. The exact relationship between torque losses 
due to cable bending and bearing friction were not determined. 

One disadvantage of this system is that the large wide pul- 
ley with many cables would occupy most of the elbow joint space. 
Also, the establishment of uniform strain in each cable without 
individual turn buckles may be a problem. However, the cable 
manufacturer recommends the use of multiple cables on a swaged 
fitting end with a common turn buckle. This would need further 
investigation. 
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Table IV -6 Evaluation of Alternative Methods in Counterbalance Linkage Methods 
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Figure IV- 49 Starting Torque vs Load Torque 
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Torsion Bar with Bevel Gears - This system would require a 
large-sized torsion tube to achieve a comparative torsional strain 
to other systems. Even with the most efficient type of hollow 
torsion bar the diameter of the bar would occupy the greater 
portion of the center of 12 in. dia. tube which would give no 
other access for electrical cables, etc. In addition, the extra 
loss of efficiency and backlash of the two bevel-gear pairs would 
add to the friction level in this system. 

Chain Drive - The chain-drive systems are frequently used 
for transmitting torque and where the strain changes and back- 
lash are not important factors of the design. Tight chain sys- 
tems are known to cog and to have lower efficiencies than loose 
chain systems generally used in chain drives. 

Single Tape with Spur Gear Reduction - As in the case of the 
torsion bar, an extra gear reduction will cause backlash and low 
efficiency. The spiked pulleys may also cog as in the case of 
the chain drive. Strain is minimized as well as load in the tape 
by the large gear reduction. One can use a ,010 in. to .015 in, 
thick by 4 in. wide tape for low bending stress operation. 

Multiple Tape - This is a direct drive system with multi- 
layer tapes. It provides a good combination of bending and ten- 
sile stresses. Each tape, however, must be continuous, with 
turnbuckle adjustment mandatory. To accommodate the large number 
of turnbuckles , the 12 in. dia tube envelope is not adequate, 
furthermore, the extra friction between tapes may cause effic- 
iency problems for the system. 

Quadruple Bar with Spur Gear Reduction - This four bar system 
will eliminate bending stresses found in tapes or cables. The 
bars are mounted 90 apart on plates on a common shaft with a 
drive pinion. The active bars are under pure tension. However, 
the gear reduction has additional backlash and complexity and 
will decrease the efficiency of the system. 

Multiple Bar, Direct Drive - This system has all the good 
features of those discussed above and was selected for bread- 
boarding. Four or three bars can be implemented. The disad- 
vantage in this system is the extra weight of the bars, and some 
inertial increase of the system can be anticipated. The bread- 
board design and test results are presented below. A simplified 
version of this is the recommended method for the AMS and is 
discussed in Section 4. 
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3 . Breadboard 


Analytical evaluation of these several systems led to the 
decision to build a prototype of the multiple bar counterbalance 
linkage system using four bars, thereby proving the feasibility 
of the design. Its basic principle relies on the kinematics of 
the four bar linkage. Figure IV-50 depicts the concept with only 
one bar shown. The lower arm of the AMS now can be attached to 
one side of the crank (R) and to the other side a counterbalance 
weight is added to establish a mechanical equilibrium for the 
system. A torque is transferred via a tension bar to a point 
about 20 ft away. As the moment varies with the angular change 
(9) of the lower arm, the tension in the bar also varies similar- 
ly, carrying the load to the counterweight up to 90 rotational 
displacement. Because of the dead center condition (R cos 9=0) 
the arm is unable to transfer any more moment to the counterweight 
and another connecting bar and crank must be introduced to the 
system. This bar must be out of phase from the first one. So 
the arm now once again is Q capable of transferring moment to the 
counterweight over the 90 limit. Then if the gravitational 
forces are inverted, a mirror image of the above bar and crank 
must be accommodated in the design. This four bar system was 
designed and fabricated as shown in Figure IV-47 (Multiple Bars, 
Direct Drive). It is similar to the final test article drawings 
no. RES3156050 and RES3150054 which are discussed in Section 4. 

The multiple bars (each 1/2 in. x 2 in. x 16 ft) are attach- 
ed to a separate disc plate so as to be non-interfering. Turn- 
buckles were provided to take up slack and pretension. Figures 
IV-51, IV-52, and IV-53 show the four bar system. It was mount- 
ed on a channel between two vertical , columns .. Figure IV-54 shows 
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Figure IV-54 Test Setup of Counterbalancing System 




the four bar system enclosed in 12 in. dia tubing to represent 
an approximate arm size. 

Several things were learned from the four bar breadboard 
assembly: 

(1) Turnbuckles were difficult to adjust and align, 

(2) Three rods could do the required job (and take less 
space and be lighter), 

(3) Single rods without turnbuckles would aid in alignment 
and be easier to install. 

These things prompted the modifications as shown in drawings 
RES3156050 and RES3156054 that represent the final test bread- 
board. Figures IV-55 and IV- 5 6 show the test apparatus in its 
final configuration. 


Torques to simulate actual AMS arm loaded conditions were 
obtained by simply suspending lead shot in bags in a manner so 
the lever arm was constant for each end (except for angular pos- 
ition that was easily calculated). 

For each load condition, and at several angles, breakaway 
friction torque values were obtained by adding shot until break- 
away. 


Variation of Friction Torque with Arm Position 


The curves in Figure IV-57 show the variation of bearing 
friction with load. The load on bearings varies with the angu- 
lar position of the arm (weight or torque at 0 times cos 0)and 
the data should reflect this. The bars had slight deformation 
in them, thereby causing some effect on the bearing load and the 
data obtained. Average efficiency is about 97.5%. 

Starting Torque (Stiction) - One of the most important con- 
siderations of the counterbalancing system is the influence of 
bearing friction on starting torque. The bearings will see both 
axial and radial. The breadboard test system utilized the "type 
x" bearing by Kaydon Corporation for the large diameter support- 
ing the drive disks and the catalog (analystical) frictional char- 
acteristics shown in Figure IV- 5.8 apply. 
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Figure IV-55 Triple Bar Counterbalancing Breadboard Test Setup 





■H 

■M 

— j 


I® I::--.-. 

■ inflMK 


HMMl 




1181 

88|ll:llll: : 


Hi 


■ ■ 


III 

II 




■ 


' ■ : : ■ ; ■ ... II|;I£skjI: 

WWj RSig v. 


IV-97 


Figure IV-56 Closeup View of the Cranking Mechanism of a Triple Bar 
Counterbalancing Breadboard 



Starting Torque Ft -Lbs 





For comparison of experimental and analytical results assume 
a typical load of 1200 ft-lbs. Thrust loads are neglected for 
this comparison. The load on bearing (P) will be: p 1200 _ 

4/12 “ 

3600 lbs (Read starting Torque from Graph), This load will apply 
to large bearings at the arm end and the large bearings at the 
counterweight. Therefore, the total starting torque should be: 

— ■- “ 18.3 ft-lbs. Comparing this to the measured 


21.5 ft-lbs torque (Figure IV-59) it can be concluded that high 
percentage of the starting friction originates in the large di- 
ameter bearings. A linear extrapolation to 1600-2000 ft-lbs 
would appear conservative and reasonable assuming the initial 
bearing capacity was not exceeded. 



Figure IV-59 Breakaway Torque Losses 
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4. Counterbalance Design For AMS 

The final des ign of the recommended AMS counterbalance link- ■ K - 
age system is presented here. It is a three bar system, each 
located 120 apart. This is the result of comparing the various 
alternatives, and the breadboard fabrication and test program 
results presented above. ‘ :i ! i: ' v 

. .. ,• .. j . : :• ; ■<$ _ 

The total counterbalance linkage system is shown schematically 1 
in Figure IV- 60. ■> ^ ; • 



In order to avoid interference of one bar by the other each -ctf 
the three bars is mounted on a separate power or crank plate. ^ ' 

Their assemblies form a crankshaft-piston rod combination simi- 
lar in concept Q to an automobile engine. The pin locations in the 
plates are 120 out of ; phase from each other (evenly divided, on 
the diameter). The same arrangement of drive disks, etc., as 
shown in drawings RES3156050 and RES3156054 will be used. Space 
has been allowed in the elbow joint for this mechanism. (See 
drawing RES3156339). 
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The three bars will form a symmetrical assembly. The sym- 
metry is important from the point of view of sensitivity. An 
out of phase bar will influence the stability of the counterbal- 
anced equilibrium of the system. This can have a very consider- 
able influence especially at no load condition. A short proof 
is presented here that if the bars are located 120 out of phase 
from each other then the moments about the center of rotation (c) 
caused by their weights will be in equilibrium under any angular 
position. This geometry is shown in Figure IV- 61. 



W/2 


Figure IV-61 Three Bar Counterbalance Geometry and Loads 


One can displace the angular position of the crank by an angle 
9 then to have equilibrium, the sum of the moments around c must 
vanish. (M^ = 0). 

W Rcos© - W Rsin (30° + 0)- W Rsin (30° - 0)= 

2 2 2 
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W R(cos9 - sin 30° cos 9 - cos 30° sin/9 - sin 30° cos9 + 

2 

cos 30° /sin) = 

= H. R( cos ® " sin 30° cos9 - cos 30° sin/9 - sin 30° cos9 + 

2 o 

_ _o . . x 
cos 30 /sm) = 

W R (cos 9-2 sin 30° cos9) = 0 
2 

Therefore, the tension bars will not influence the equilibrium 
condition or sensitivity of the system under any angular position. 

The upper arm tube diameter will be the only limitation of 
size of the system. The recommended system uses 8 in. drive 
diameter and an 11 in. overall diameter, which is a convenient 
size to work with inside the 12 in. structural tube of the AMS. 

The working volume of the three bars is 2.5 in. x 10 in. 


The same 2 in. by 1/2 in. cross section cold rolled steel 
used for the breadboard bar was selected for each connecting bar. 
This can later be increased or decreased in size to vary stiff- 
ness. The magnitude of the tensile stress and strain in the bar 
is calculated to be 7000 psi and 0.00275 in. /in. , respectively. 

From dynamics and buckling stress point of view the maximum 
compressive load should be calculated. The critical load for the 
above bar with hinged ends can be found from the Euler critical 
load formula: 



Where: I = Moment of inertia of cross section with respect to 

z / 


the neutral axis for rectangle I = 1_ 

Z 12 

2 6 

Then: P„„ = x 30 x 10 ,, 

CR 7 . — = 108 lbs, 

(240) 48 


b h3 


1=1 
2 48 


in 
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This means, the bar has practically no load carrying capacity as 
a column. However, before the bar buckles the opposite tension 
bar will assume the torque load in tension. One might say that 
all of the counterbalance torque transmittal loads are carried in 
the bars in tension, with the compressive forces negligible. 

In designing the crank pins, the forces shown in Figure IV-62 
are taken into account. 


I 


Shaft 


^ — *~ p/z 



► P/2 

Bearing Support 


Figure IV-62 Typical Double Shear Pin Connection 


Using SAE4340 steel the minimum pin size is calculated to be 
0.382 in. diameter. 

The drive disks at the elbow and at the opposite end will be 
identical, even the method of attaching the output torque tube 
from the drive disks to the yoke. 

The bearings used in the breadboard test apparatus for out- 
side diameter drive disk support should be entirely adequate for 
the final design and are shown in the elbow joint design dashed 
in the drawing RES3156339. Small needle bearings were used as 
the connecting rod bearings. More accurate bearings of the same 
type should be used in the final assembly. 

The entire counterbalance system should operate as effic- 
iently (97. 57o) as the test apparatus. 
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D. 


OVERALL MANIPULATOR DESIGN 


Figure IV- 63 is the design layout of the AMS manipulator. 
The base and post are designed to allow mounting the yoke in 
the vertical or horizontal orientations. The counterbalancing 
linkage design is based on the 3-bar breadboard results. The 
design of the shoulder and elbow joints has been discussed 
in Section A. (The wrist and terminal device designs are not 
a requirement of this contract) Tube connections are shown in 
drawing RES3156301 . 

A model of the AMS manipulator was designed and fabricated. 
Figures IV- 64 through IV-69 are photographs of various views. 

The model is scaled to approximately "15%. , This, permits it 
to be used easily on a desk top and for transporting with 
luggage, yet it is large enough to demonstrate concepts . The 
arm length from shoulder to tip is 6 ft. The base supports 
the arm with stability regardless of arm position or with the 
yoke mounted either vertically or horizontally. 

A braking device was installed at each joint to enable 
partial friction to be applied to hold fixed in specific 
positions. These were clamping or pressure type arrangements 
for model purposes only. The counterbalance torque transmittal 
for the model utilized 1/16 in. diameter cable, rather than 
the connecting bars recommended for the full scale manipulator. 
This was sufficient for the 157 0 model, There was no sacrifice 
in elbow to wrist articulation due to this variation. This 
model proves the articulated counterbalancing concept. 
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Figure IV-63 Assembly Drawing of Counterbalanced Manipulator 












Ml 




: ; l-/' '■ 


1111 


lllillilliSIli® 

liter. 

■'ll; ■ 

iiiiiiif .il 


1 : 1 : 






: : § \ 


I 


Mi ■•■ 


mm mm 


am 




'• ; • '; 


AMS Manipulator Model with Yoke Mounted in Vertical Position 
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Figure IV-66 AMS Manipulator Model With Yoke Mounted in Horizontal Position 
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Figure IV-68 AMS Manipulator Model Showing Counterbalance Linkage Cabling at Elbow 
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V. 


CONTROL DEVICES 


Introduction : 

The primary intent of this series of developmental evalua- 
tions and simulations is to establish design criteria and 
develop a preliminary configuration of a position, bilateral 
(force feedback), master controller for a spacecraft cargo 
handling manipulator system. The analysis completed, to date, 
represents a good definition of the problem and some preferred 
designs, but many areas need further work. 

The design of any controller can never evolve adequately 
without a full understanding and integration of the total system 
objectives and requirements. In this case, the controller, the 
manipulator and the control electronics must evolve together 
in complete harmony. Associated with this is the problem of 
how much control authority is assigned to the operator (manual) 
and how much is automatic or computer controlled. This problem 
is attacked only on the basis that, for the manipulator tasks 
evaluated, the operator was given full manual control. 


The first question one must ask at the beginning of con- 
troller design evaluation is what must the controller make the 
manipulator do? Our approach to the problem (as outlined in 
Figure V-l) is to develop "Operational Requirements" by first 
examining the latest NASA Shuttle Traffic Model, which provides 
a gross categorization of Shuttle payloads, their masses 
sizes and general operational characteristics. This criteria 
served for the basis of the next phase, "Manipulator Trajec- 
tory Definition", (Section II, B&C) which derived manipulator 
trajectories and reach capabilities as related to an actual 
shuttle and manipulator configuration. 

Existing Human Engineering data was surveyed as related 
to position controllers. Basic data is readily available, 
and is shown in Section V,A. However, specific design criteria 
for a bilateral, position controller with indexing and selec- 
table movement ratios must be derived from analysis and simula- 
tions. 

"Design Evaluations" consisted of a combination of an 
analytical derivation of optimizing controller joint ordering 
and a hardware evaluation utilizing a variety of full scale 
controller mockups , semi-operational breadboards and a fully 
operational position controller. These controllers 
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were used in dynamic simulations using a video presentation 
which simulated tracking tasks (Appendix C) and our Space 
Operations Simulator which provided full 6-DOF dynamic tasks. 
Tracking, pre-capture and cargo handling tasks were simulated. 
Both rate and position controllers were utilized for manipu- 
lator control and their operational characteristics were 
varied for subject evaluations. 

/ 

As a result of the analysis and simulations. Recommenda- 
tions and Conclusions are made for the con troller/manipulator 
system operational characteristics. A recommended 6 -DOF 
position controller is presented along with a full scale 
mock up . 
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Figure V-l Manipulator Controller Development 




A. EXISTING HUMAN FACTORS CONTROLLER DATA 


Concurrent with the Trajectory Definition study, applicable 
existing data on controller design and human characteristics was 
evaluated. Applicable data was assembled in two categories. 
These are: 

Human Characteristics 


a. An th r o p ome t r ic 

b. Strength 

c . Endurance 

d. Force Sensing 

e. Arm Jitter 

f. Kinesthetic Sensing 

Control Optimization 

a. Cross Coupling 

b. Friction 

c. Stiction 

d. Backlash 

e. Dead space 

f. Feedback Levels 

1. Anthropometric Reference* 

Anthropometric data for various applicable populations 
(flying personnel and astronauts, in particular) are well docu- 
mented and readily available for design use. This data includes 
body segment sizes as related to the population percentile as shown 
in Figure V-2 , joint and limb movement limits are shown in Figure 
Vr3. For our preliminary controller configuration analysis , operator 
sizes between 5 and 95 percentile were used. Air Force flying 
personnel data was used for the preliminary design because it * s 
readily available. However, as the position controller, design is 
refined, actual current astronaut populations should be used. 


* Data - The data and text in this section was extracted from 
"Anthropometry of Flying Personnel", WADC TR52-321. 
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Anthropometry of Flying Personnel 


Percentile Values 


Percentile Values 

_% CM IN. 

1 161.3 63.5 

2 163.0 64.2 

3 164.0 64.6 

5 165.5 65. 2 

10 167. 6 6§. 0 

15 169. 1 66. 6 

20 170.4 67.1 

25 171.4 67.5 

30 172.4 67.9 

35 173.3 68.2 

40 174.1 68.5 

45 174. 9 68.9 

50 175.6 69.1 

55 176.4 69.4 

60 177. 1 69. 7 

65 177.9 70.1 

70 178.8 70.4 

75 179. 7 70. 7 

80 180.7 71.1 

85 181.9 71.6 

90 183.5 72.2 

STATURE 95 185.8 73.1 

97 187.3 73.7 

Subject stands erect looking 98 188.5 74.2 

directly forward (head oriented 99 190.3 74.9 

in the Frankfort plane). With 
the anthropometer arm firmly 

touching the scalp, measure the vertical distance from the floor 
to the top of the head. 

Mean: 175.54 (.10) cm; 69.11 (.04) in. 

Standard Deviation: 6.19 (.07) cm; 2.44 (. 03) in. 

Range: 151-197 cm; 59.45 - 77.56 in. 

v = 3.53 (.04)% N = 4062 


Figure V-2a 


_% CM IN. 

1 86.7 34.1 

2 88.0 34.6 

3 88. 9 35. 0 

5 90.0 35.4 

10 92. 1 36. 2 

15 93.1 36 .7 

20 94.1 37.1 

25 94.8 37.3 

30 95.6 37.6 

35 96.2 37.9 

40 96.9 38.1 

45 97.5 38.4 

50 98.1 38.6 

55 98. 7 38.9 

60 99.3 39.1 

65 100.0 39.4 

70 100. 6 39. 6 

75 101. 3 39. 9 

80 102. 0 40. 2 

85 102. 9 40. 5 

90 104.1 41.0 

MAXIMUM REACH FROM WALL 95 105.9 41.7 

97 107.3 42.2 

Subject stands erect in a cor- 98 108.3 42.6 

ner of the room, his back 99 109.8 43.2 

pressed against the rear wall 
and his right shoulder thrust as 

far forward as possible, his right arm and hand extended hor- 
izontally along the side wall. Using the scale on the side 
wall, measure the distance from the rear wall to the tip of 
the longest finger. 

Mean: 98.03 (.08) cm; 38.59 (.03) in. 

Standard Deviation: 4.82 (.06); 1.90 (.02) in. 

Range; 79-117 cm; 31.10-46.06 in. 

V = 4.92 (.05)% N = 4055 

Figure V-2b 
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Anthropometry of Flying Personnel 


Percent lie Values 


Percentile Values 



FOREARM- HAND LENGTH 

Subject sits erect, his right 
upper arm hanging at his side, 
his forearm and hand extended 
horizontally. Using the anthropo- 
meter, measure the distance from the 
to the tip of the longest finger. 


Mean: 47.91 (.03) cm; 18.86 (.01) in. 

Standard Deviation* 2.07 (.02) cm; .81 (. 01) in. 
Range: 39-56 cm; 15. 35-22. 05 in. 

V = 4.41 (.05)% N = 4059 


% 

CM 

IN, 

1 

43.2 

17.0 

2 

43.7 

17.2 

3 

44. 1 

17.4 

5 

44. 6 

17.6 

10 

45.3 

17.8 

15 

45.8 

18.0 

20 

46.2 

18.2 

25 

46.6 

18.3 

30 

46.9 

18. 5 

35 

47.2 

18.6 

40 

47.4 

18.7 

45 

47.7 

18.8 

50 

48.0 

18.9 

55 

48.2 

19.0 

60 

48.5 

19.1 

65 

48.8 

19.2 

70 

49.0 

19. 3 

75 

49.4 

19.4 

80 

49.7 

19.6 

85 

50.1 

19.7 

90 

50.6 

19.9 

95 

51.2 

20.2 

97 

51.8 

20.4 

98 

52.1 

20.5 

99 

52.6 

20.7 

tip of 

the right 

elbow 



SHOULDER HEIGHT, SITTING 
(ACROMIAL HEIGHT, SITTING) 

Subject sits erect, his feet 
resting on a surface so that the 
knees are bent at about right 
angles. Using the anthropometer , 
measure the vertical distance from 
right acromion as marked. 


% 

CM 

IN. 

1 

52.2 

20.6 

2 

53.0 

20.9 

3 

53.5 

21.1 

5 

54.2 

21.3 

10 

55.3 

21.8 

15 

56.1 

22.1 

20 

56. 7 

22.3 

25 

57.2 

22.5 

30 

57.6 

22. 7 

35 

58.0 

22.8 

40 

58. 4 

23.0 

45 

58. 8 

23.1 

50 

59.2 

23.3 

55 

59.5 

23.4 

60 

59.9 

23.6 

65 

60.3 

23. 7 

70 

60.6 

23.9 

:75 

61.0 

24.0 

80 

61.5 

24.2 

85 

62.0 

24.4 

90 

62.8 

24.7 

95 

63.8 

25.1 

97 

64.4 

25.4 

98 

64.9 

25.6 

99 

65.6 

25.8 


the sitting surface 


Mean: 59. 07 (. 05) cm; 23. 26 (. 02) in. 

Standard Deviation: 2.89 (.04) cm; 1.14 (.02) in. 

Range: 48-69 cm; 18.90-27. 17 in. 

V = 4.89 (.05)% N = 4057 


Figure V-2e 


Figure V-2f 


Percentile Values 


Percentile Values 



% 

CM 

IN. 

1 

18.8 

7.4 

2 

19.4 

7.6 

3 

19. 7 

7.8 

5 

20.1 

7.9 

10 

21.0 

8,3 

15 

21. 4 

8.4 

20 

21.9 

8.6 

25 

22.2 

8. 7 

30 

22.5 

8. 9 

35 

22.8 

9.0 

40 

23. 1 

9.1 

45 

23. 3 

9.2 

50 

23. 6 

9.3 

55 

23.8 

9.4 

60 

24. 1 

9.5 

65 

24.3 

9.6 

70 

24.6 

9. 7 

75 

24.8 

9.8 

80 

25.2 

9.9 

85 

25.5 

10.1 

90 

25.9 

10.2 

95 

26,5 

10.4 

97 

26.8 

10.6 

98 

27.1 

10.7 

99 

27.6 

10.9 


WAIST HEIGHT, SITTING 95 26.5 10.4 

97 26.8 10.6 

Subject sits erect, his feet rest- 98 27.1 10.7 

ing on a surface so that his knees 99 27.6 10.9 

are bent at about right angles. 

Using the anthropometer, measure 

the vertical distance from the sitting surface to the waist 
point marked on the rigtit side. 

Mean: 23.46 (.03) cm; 9.24 (.01) in. 

Standard Deviation: 1.94 (. 02) cm; . 76 (.01) in. 

Range: 16-33 cm; 6,30-12.99 in. 

V = 8. 27 (. 09)% N = 4062 



SITTING HEIGHT 

Subject sits erect, looking 
directly forward (head oriented 
in the Frankfort plane), and 
his feet resting on a surface 
so that his knees are bent at about 
thropometer arm firmly touching the 
from the sitting surface to the top 


% 

CM 

IN. 

1 

83.5 

32, 9 

2 

84.6 

33.3 

3 

85. 1 

33.5 

5 

85.8 

33.8 

10 

87.2 

34.3 

15 

87.9 

34.6 

20 

88.6 

34.9 

25 

89.1 

35.1 

30 

89.6 

35.3 

35 

90.1 

35.5 

40 

90.5 

35.6 

45 

90.9 

35.8 

50 

91.4 

36.0 

55 

91.8 

36.1 

60 

92.2 

36,3 

65 

92.6 

36.5 

70 

93.1 

36.6 

75 

93.6 

36.8 

80 

94.1 

37.0 

85 

94. 7 

37.3 

90 

95.5 

37.6 

95 

96.6 

38,0 

97 

97.4 

38.3 

98 

98.0 

38,6 

99 

98.9 

38.9 


right angles. With the an- 
scalp, measure Vertically 
of the head. 


Mean: 91.28 (.05) cm; 35. 94 (. 02) in. 

Standard Deviation: 3. 27 (.04) cm; 1.29 (. 02) in. 

Range* 76-102 cm; 29. 92-40. 16 in. 

V = 3.58 (.04)% N - 4061 


Figure v-2g 


Figure V-2h 



Anthropometry of Flying Personnel 


Percentile Values 


Percentile Values 



% 

CM 

IN. 

1 

72.4 

28.5 

2 

73.3 

28.9 

3 

73.8 

29.1 

5 

74. 7 

29.4 

10 

76.0 

29.9 

15 

76.7 

30.2 

20 

77.3 

30.4 

25 

77.8 

30.6 

30 

78.3 

30.8 

35 

78.8 

31.0 

40 

79.2 

31.2 

45 

79.6 

31.4 

50 

80.0 

31.5 

55 

80.4 

31.7 

60 

80.8 

31.8 

65 

81.3 

32.0 

70 

81. 7 

32.2 

75 

82.2 

32. 3 

80 

82. 7 

32.6 

85 

83. 3 

32.8 

90 

84. 1 

33.1 

95 

85. 2 

33.5 

97 

85. 9 

33.8 

98 

86.4 

34.0 

99 

87.3 

34.4 


EYE HEIGHT, SITTING 
(INTERNAL CANTHUS HEIGHT, 
SITTING) 


Subject sits erect, looking 99 87.3 34.4 

directly forward (head oriented 
in the Frankfort plane), his 

feet resting on a surface so that the knees are bent at about 
right angles. Using the anthropometer, measure the vertical 
distance from the sitting surface to the inner corner of the 
eye. 

Mean: 79.94 (.05) cm; 31.47 (.02) in. 

Standard Deviation: 3.22 (.04) cm; 1.27 (.02) in. 

Range: 67-93 cm; 26.38-36.61 in. 

V = 4. 03 (. 04)% N = 4061 

Figure V-2i 



% 

MM 

IN. 

1 

170.9 

6.7 

2 

172.9 

6.8 

3 

174.2 

6.9 

5 

175.9 

6.9. 

10 

179.3 

7.1 

15 

181.4 

7.1 

20 

183. 1 

7.2 

25 

184.4 

7.3 

30 

185.6 

7.3 

35 

186.9 

7.4 

40 

188.1 

7.4 

45 

189.0 

7.4 

50 

189. 8 

7.5 

55 

190. 9 

7.5 

60 

192. 1 

7.6 

65 

193.3 

7.6 

70 

194.5 

7. 7 

75 

196.1 

7.7 

80 

197.8 

7.8 

85 

199.3 

7.9 

90 

201.4 

7.9 

95 

204.4 

8.0 

97 

206.5 

8.1 

98 

208. 1 

8.2 

99 

210. 5 

8.3 


HAND LENGTH 95 204.4 

97 206.5 

Subject* s right hand is extended, 98 208.1 

palm up. With the bar of the 99 210.5 

sliding caliper lying along his 

palm, measure the distance from the proximal edge of 
navicular bone at the wrist to the tip of the middle 

Mean; 190.23 (.13) mm; 7.49 (.01) in. 

Standard Deviation: 8.60 (.09) mm; .34 (.00) in. 

Range: 149-222 mm; 5.87-8.74 in. 

V = 4.52 (.05)% N = 4063 


Figure V-2j 


Percentile Values 


Percentile Values 



HAND BREADTH AT METACARPALE 95 95. 1 3. 74 

97 96.1 3. 78 

Subject’s right hand is extend- 98 96.9 3.81 

ed, palm up. With the bar of 99 98. 1 3. 86 

the sliding caliper lying across 

his palm, measure the maximum breadth across the distal ends 
of the metacarpal bones (knuckles) . 

Mean: 88.33 (.06) mm; 3.48 (. 00) in. 

Standard Deviation: 4.11 (.04) mm; ,16 (.00) in. 

Range* 76-104 ran; 2.99-4.09 in. 

V « 4. 65 (.05)% N = 4058 







% 

MM 

IN. 

% 

MM 

IN. 



1 

91.2 

3.59 

1 

79.3 

3. 12 



2 

92.5 

3.54 

2 

80.2 

3.16 


\ \ 

3 

93.4 

3.68 

3 

80,8 

3. 18 


' ' 1 

5 

94. 7 

3. 73 

5 

81. 7 

3.22 


1 \ \ \ 

10 

96.6 

3. 80 

10 

83.3 

3.28 


1 r r 

15 

98.3 

3.87 

15 

84.1 

3. 31 



20 

99.1 

3. 90 

20 

84, 7 

3. 34 


L V-L \ f 

25 

99.8 

3.93 

25 

85,4 

3. 36 


r 

30 

100.5 

3. 96 

30 

86,0 

3.39 



35 

101. 3 

3.99 

35 

86,6 

3.41 


- // ^ 

40 

102.0 

4.02 

40 

87.2 

3.43 

V 


45 

102.8 

4.05 

45 

87.8 

3.46 

r 


50 

103. 7 

4. 08 

50 

88.5 

3.49 

\ 

{ / 

55 

104. 1 

4. 10 

55 

88. 9 

3.50 

\ 


60 

104.7 

4.12 

60 

89.2 

3.51 


r f 

65 

105.4 

4.15 

65 

89. 7 

3.53 

1 

i i 

70 

106.1 

4.18 

70 

90.4 

3.56 



75 

107.0 

4.21 

75 

91. 1 

3.59 



80 

108.0 

4. 25 

80 

91. 8 

3. 61 



85 

109. 1 

4.30 

85 

92.6 

3.65 



90 

110.4 

4.35 

90 

93,8 

3.69 

HANE 

) BREADTH AT THUMB 

95 

112. 2 

4.42 

95 

95.1 

3. 74 



97 

113.6 

4.47 

97 

96.1 

3. 78 

Subject 

:*s right hand is extend- 

98 

114.6 

4.51 

98 

96. 9 

3.81 

ed, palm up, with the thumb 

99 

116.1 

4.57 

99 

98.1 

3. 86 

lying a 

ilong side and in the 





plane of the palm. With the bar 
ing on the palm and the caliper* s 
(the joint of the metacarpal bone 
the thumb, measure the breadth at 
axis of the hand. 


of the sliding caliper rest- 
fixed arm at the knuckle 
and the first phalanx) of 
right angles to the long 


Mean: 103.49 (.08) mm; 4.07 (.00) in. 

Standard Deviation: 5. 31 (. 06) mm; ,21 (, 00) in. 

Range: 82-121 mm; 3. 23-4. 76 in. 

V = 5.16 (.06)% N = 4062 


Figure V-2k 


Figure V-2L 



ARM REACH ENVELOPES 


Anthropometry of Flying Personnel 


Percentile Values 

Jo MM IN. 

1 25.4 1.00 

2 25. 9 1. 02 

3 26. 3 1.03 

5 26. 7 1. 05 

10 27.4 1.08 

15 27.9 1.10 

20 28. 3 1. 11 

25 28.6 1.13 

30 28.9 1.14 

35 29.1 1.14 

40 29.3 1. 15 

45 29.5 1.16 

50 29.7 1.17 

55 29.9 1.18 

60 30.1 1.18 

65 30.3 1.19 

70 30.5 1.20 

75 30. 7 1. 21 

80 31.0 1.22 

85 31.4 1.24 

90 31.8 1.25 

THICKNESS AT META CARP ALE III 95 32.5 1.28 

97 33.1 1,30 

Subject's right hand is held 98 33.5 1.32 

with the fingers extended. 99 34. 2 1. 35 

Using the sliding caliper, 

measure the thickness of the knuckle (the joint of the meta- 
carpal bone and the first phalanx) of the middle finger. 

Mean: 29.67 (.03) mm; 1.17 (.00) in. 

Standard Deviation: 1.80 (.02) mm; .07 (.00) in. 

Range: 19-39 mm; .75-1.54 in. 

V = 6. 07 (. 07)% N = 4061 



Useful limits for arm reach should be based on those of the 
small man. In the accompanying graphs selected data for a 
man with a 5th percentile arm reach are shown. In the first 
plot the subject was in shirtsleeves and not restricted by 
shoulder harness. In the second, he was restricted by shoulder 
harness. 



DISTANCE FORWARD — INCHES 



25 20 15’ »0 5 0 -5 -1C 

DISTANCE FORWARD - 1NCHE5 


Figure v*2m 


Figure V-3 
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2. Human Arm Kinesthesis and Tactual Discrimination 


In the design of a position controller that has force feed- 
back, the operator will be required to exert forces on the 
manipulator for extended periods of time and at various angles. 

To derive this force level design criteria for a controller, 
one must first look at man’s capabilities. The data and text 
in this section was extracted from "Human Engineering" 

E. J. McCormick. 

The strength that can be exerted varies with the position 
of the arm and with the direction of the movement. Because of 
this, the maximum forces to be overcome in making arm movements 
should depend upon the position of the arm and direction of the 
movement. 

Information relating to strength of such movements for 
seated operators comes from a study by Hunsicker . In this 
study, 55 male subjects made movements in each of various di- 
rections, with the upper part of the arm in each of several 
positions. The arm positions and directions of movement are 
illustrated in Figures V-4a and V-4b . Figure V-4a shows 
a side view with the arm in each of the five positions, namely 
180° (straight forward), 150°, 120°, 90° (straight down), and 
60 (back at an angle). In each such position of the upper 
arm, movements were made as follows: push, pull, up, down 
(as shown in Figure V-4a) , and in (adduction) and out (abduction) 
(as shown in Figure V-4b). The strength of each subject for 
each movement was recorded a nd some of the results are given in 
Table V-l This table shows, for each movement, the maximum 
strength of the 5th percentile, and the mean maximum strength. 

The data for the 5th percentile are shown, since they repre- 
sent values that most of the subjects (95 percent) exceeded. 
Forces greater than these normally should not have to be 
overcome in work situations, unless the operators are to be 
specially selected on the basis of strength. Even these 
forces should not be required if it is possible to avoid them, 
because of the possible fatigue which some operators would 
experience in overcoming them. 
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Table V-l Arm Strength in Pounds 


Angle 
of arm, 
degrees 

5th 

Percentile 

Mean 

5th 

Percentile 

Mean 

Left 

Right 

Left 

Right 

Left 

Right 

Left 

Right 

Pull 

Push 

180 

50 

52 

116 

120 

42 

50 

126 

138 

150 

42 

56 

112 

122 

30 

42 

111 

123 

120 

34 

42 

94 

104 

26 

36 

99 

103 

90 

32 

37 

80 

88 

22 

36 

83 

■ 86 

60 

26 

24 

64 

63 

22 

34 

80 

92 


Up 

Down 

180 

9 

14 

41 

43 

13 

7 

17 

35 

41 

150 

15 

18 

52 

56 

18 

20 

41 

47 

120 

17 

24 

54 

60 

21 

26 

51 

58 


17 

20 

52 

56 

21 

26 

49 

53 


15 

20 

44 

49 

20 

20 

46 . 

51 


In 

Out 

180 

13 

20 

43 

50 

8 

14 

30 

34 

150 

15 

20 

47 

54 

8 

15 

29 

33 

120 

20 

22 

45 

53 

10 

15 

30 

34 

90 

16 

18 

48 

50 

10 

16 

33 

37 

60 

17 

20 

50 

52 

12 

17 

32 

42 


These results show the max imums for the 5th percentiles 
are noticeably lower than for the means. For any given move- 
ment (such as a pull, or a push), the relative strengths of the 
5th percentiles for the various arm angles fall in approximately 
the same rank order as the relative strengths of the means for 
the corresponding angles. The left hand values are consistently 
below those for the right hand, the difference being approxi- 
mately 10 percent. 

Considering the individual movements in relationship to 
the arm angle, it can be seen that both pushes and pulls are 
somewhat stronger when the arm is extended forward (at 180° 
or 150°) than when it is more down to the side. With up 
and down movements, however, greater strength can be exerted 
with the arm more to the side (around 120° or 90°) than ex- 
tended forward. For inward and outward movements, the arm 
position seems to have little influence, except that there 
seems to be a slight advantage for outward movements in a 
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side position (90° or 60°). 

Comparing the various movements with each other, it can 
be seen that greater force can be exerted by pulling or pushing 
actions than by up, down, in, or out movements. There is a 
slight advantage for pushing movements over pulling. Otherwise, 
the relative strengths of the various movements, in descending 
order, are up, down, in (adduction), and out (abduction). The 
out movement was, on the average, less than a third as strong 
as the strongest movement, the push. 

The pulling and pushing movements in this study were made 
in a horizontal plane. For position controller activities, 
pulling or pushing movements are made at an angle , either 
oblique with the floor, or off to the left or right. Informa- 
tion based on small samples implies that, with upward pulling 
action at an oblique angle with the floor, the strength that 
can be exerted is related to the height of the hand grip. With 
the hand grip 6 in below the seat level, the strength exerted 
was greater than with the hand grip 13 in above seat level. 

A higher hand grip (+ 19 in) made the action especially diffi- 
cult. In a horizontal pushing action, it was found that 
greater strength could be exerted if the direction of the move- 
ment was straight ahead, rather than at right or left angles 
from the shoulder. The right angle, in particular, loses in 
mechan ic a 1 advantage , 

In connection with a pushing action, it has been found that 
greater force can be exerted if the feet are placed forward 
with the legs at an oblique angle, rather than being placed 
flat on the floor right in front of the seat. For example, 
men with their feet against a pedal nearly straight ahead from 
the seat could exert as much as 135 lb, whereas when seated 
normally, they could exert only about 75 lb. 

Push and Pull by Hand from Standing Position 

Since some pushing and pulling is done in a standing posi- 
tion, the relationship between the position of the control 
device, direction of movement, and the force that can be exerted 
was examined. A study by Garry utilized equipment 
consisting of a 30-in lever that rotated in a vertical plane. 

It was so devised that it was possible to position the lever 
at any given angle and to determine the amount of force 
applied to the lever at each angular position. As the handle 
of the lever was positioned at any given angle from the center. 
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the center itself moved up or down so that the handle of the 
lever could be set at any given distance above or below 
shoulder height. The level was varied from 30 in below shoulder 
height to 24 in. above shoulder height. Depending on the height 
of the handle, the angle from the center, and whether the handle 
was being pushed or pulled, the subject then would assume what- 
ever posture or stance was appropriate for the action. 


Pounds 


Kilograms 



Center 

Grip * 

180 0 

Cen ter - 


/ 


i '\ 


204 ° 223 0 270 ° 307 8 336 ° 0 ° 

/ I \ ^ — 

Lever angle and position 


Figure v-5 Maximum Push and Pull Force 
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The resulting data are given in Figure V-5 These data 
are for selected grip levels (+ 18 in, 0. - 18 in, and - 30 in 
from shoulder level). The angular positions are represented 
as follows: 0°, 90 , 180°, and 270°, or, respectively, 3, 12, 

9, and 6 o'clock positions. For above shoulder levels of + 18 
in the maximum forces could be exerted with the lever angle 
approaching horizontal (0 and 180 ) . In such positions a 
pulling-down action was stronger than a pushing-up action. At 
shoulder height the 127 and corresponding 307° positions were 
weakest. Generally speaking, the - 30-in level resulted in 
greater pulling and pushing force than the - 18-in level; the 
exception was for pushing actions in approximately vertical 
positions (90 and 270 ), where apparently pushing was more 
forceful if the grip level was about waist height (- 18 in). 

At horizontal positions below shoulder height, pushing was 
generally stronger than pulling, particularly at the - 30-in 
level, where the operator presumably could really bear down 
on the lever. 

Grip Strength and Endurance 

Control devices which are to be manipulated, must be grasped 
with the hand, and the hand must be contracted in a gripping 
action. The strength required for such action should be within 
the limits of grip strength of people who are to use the equip- 
ment in question. Hand strengths vary from a force of about 75 lb 
to about 170 lb, with an average of about 125 lb. 


Comparative data are available for a group of 200 univer- 
sity male students. These data include both grip strength 
and endurance. Endurance was also measured in terms of a 
strength-endurance index, specifically the average strength in 
pounds that could be sustained for 1 min. The results, summa- 
rized in Table V-2 , include not only the averages but also the 
standard deviations (SD) of the group. Strength and endurance 
were correlated (r = .67 and .66 for right and left hands, 
respectively). Such correlations mean that people with greater 
maximum strength also tend to have more staying power. 


Table V-2 Grip Strength & Endurance 



Right hand 

Left 

Hand 


Av. 

SD 

Av. 

SD 

Average maximum strength (lb) 
Average strength endurance 

108 

21 

95 

18 

index 

62 

12 

55 

10 
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3. Side Stick Controller Forces and Travel 

The data and text in this section was extracted from the 
"Bioastronautics Data Book", NASA SP-3006 and "Human Engineering" 
by E. J. McCormick, Measurements were made of pilots arms, 
using a side stick mockup, to determine the unconstrained an- 
gular deflections they could achieve in roll and pitch. Data 
was taken with the arm straight or flexed as shown. The pre- 
fgrred neutral position for the controller was found to be 
8 to the right and 15 forward of the vertical. The pre- 
ferred arm position was a slight extension forward from 90°. 
Average pilot data is shown in Figure V-6 . 




Figure V-6 Pilots Average Arm Movements 
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Roll (Grip Position) 

Pitch (Grip Position) 


Elbow 

Angle 

L 90° 

L 45° 

0° 

R 45° 

R 90° 

Down 

60° 

Down 

30° 

lJ>! 

Up 

50° 

Operational 
Force Level 

90 ° 

L 

R 

L 

R 

L 

R 

L 

R 

L 

R 

U 

D 

U 

D 

U 

D 

u 

D 

11 

13. 5 

12 

11 

12.5 

12.5 

12 

12.5 

6.5 

7 

14 

12 

18 

17 

17 

15 

12 

14 

130° 

2 

6 

9.5 

9.5 

12 

12 

12 

12 

10 

9.5 

12 

17 

18 

20 

17 

20 

18 

17.5 

Max. Oper. 
Force Level 

90° 

22 

24.5 

24 

23 

26 

27 

20.5 

26 

11 

8 

22 

30 

31 

38 

28 

28 

20 

28 

130° 

10 

4 

19 

20 

26 

25.5 

21 

25 

11 

21 

17 

29 

33 

34 

38 

37 

35 

34 

Max. Force 
Level 

90° 

85 

8 8 1 

78 

85 | 

70 

75 

50 ! 

48 

27 

25 

95 

82 

112 

95 

75 

75 

26 

32 

130° 

18 

10 

35 

30 

67 

65 

83 

75 

80 

80 

53 

58 

73 

81 

130 

106 

120 ! 

120 


Table V-3 Angular Torques (in. -lbs.) 

Elbow and Shoulder Strength 

There are many varieties of elbow and shoulder actions, 
but two aspects of these actions may be of particular conse- 
quence in movements involving strength. 

Flexion versus extension of elbow . Can flexion (bending) 
or extension (straightening) of the elbow result in greater 
force? This question was investigated with force applied to 
a handle connected to a strain gauge. Since the handle moved 
under force, it was possible to measure force exerted at each 
of various positions. With the upper arm 'adducted (in at the 
side) and the elbow joint at one of three degrees of flexion 
(45 , 90 , and 135 ), 12 subjects attempted elbow-flexion 
(bending) and extension (straightening). 

Three results in particular are pertinent: In the first 

place, flexion (bending) turned out to be about half again as 
strong as extension (straightening). In the second place, 
the force was greater when the elbow was at about a 90° bend 
than when the bend was greater or less than this angle. In 
the third place, the force was greater with the forearm in a 
medial position (palm turned toward center) than in a prone 
or supine position. 

Elbow versus shoulder forces . In another study, a com- 
parison was made of the relative force that can be generated 
by the elbow as opposed to the shoulder. For this purpose a 
17- in. handwheel was used. This had a handle that could be 
grasped in either of two ways, namely, at right angles to the 
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forearm (as a streetcar conductor grasps his control lever), or 
parallel to the arm (like grasping the end of a fishing pole). 

The wheel was placed in six different positions, so that the arm 
positions and hand grasps were as shown in Table V-4 (the elbow 
being bent at 90 in all cases). Positions 1, 2, and 3 primarily 
required an elbow action, and 4, 5, and 6, a shoulder action. 

The actions were of extension or flexion depending on the arm 
used and direction of attempted rotation. The handwheel hardly 
moved under force, and force was measured by a strain gauge. 
Twelve subjects were tested, each one being tried on each of 
the six positions. 


Table V-4 Hand Grasp Data 




Upper-arm position 

Type of hand grasp 

Action 

At side 

Flexed 
forward 
at 45° 

Flexed 
forward 
at 90° 

Streetcar conductor 

Elbow 

i 

2 

3 

Fishing pole 

Shoulder 

4 

5 

6 


Without giving the details of the results, we may state 
the principal conclusion to be drawn from them. A rotation 
action of the shoulder has approximately 1-1/2 times the force 
of a rotation action of the elbow, and it has nearly 3 times 
as much staying power (the ability to maintain a force). Posi- 
tion and direction of rotation were not of major consequence. 

Another related study indicated that shoulder extension 
(an upward push) is more forceful than flexion (a downward 
action) from a seated position. 

Force in Controls and Reaction Time 


The need to overcome the force of a control may have 
accompanying costs, especially in speed of response. Hence, 
force is interrelated with reaction time. Reaction time to 
simple stimuli seldom is less than 0.12 sec, and perhaps more 
typically is as much as 0.25 sec. To complex stimuli, such as 
are encountered in automobile traffic, the typical time may be 
as high as 0.60 sec. Excessive resistance in a control device 
also can increase the reaction time. 

A British study yielding data on this point was carried 
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out with a cockpit mockup, in which the control stick was 
moving freely. The reaction time to a simple stimulus was 
about 0.20 sec, but with a loaded stick the reaction time 
shot up to 0.60 sec. Further evidence on this point comes from 
a flight situation in which it was reported that reaction time 
in moving a control stick increased from 0.16 to 0.75 sec as 
the load on the stock was increased from 37 to 97 lb. 

Feedback from Forces in Control Devices 


In case a control device such as a lever, steering wheel, 
or pedal is being operated by "feel" without visual cues, there 
are two types of feedback that can provide cues to guide the 
operation of the control: One of these is the pressure that is 
experienced in overcoming the force inherent in the system; this 
is sensed largely through the tactual, or touch, sensation. A 
moderate amount of inertia in cranks can improve tracking per* 
formance. The other cue is distance, or length of movement, 
which is experienced through the kinesthetic sense (from the 
proprioceptors in the muscles and joints), which keeps us in- 
formed of the position of parts of the body (arms, legs, etc). 

Where pressure is used as a cue, the operator may apply 
what he consideres to be the "right” amount of pressure. But 
how is he to know what is the "right" amount? The answer to 
this is, of course, experience. But how accurate are human 
judgements regarding amount of pressure? Can people reproduce 
a previously experienced pressure? And do these judgements 
depend somewhat on the amount of force to be overcome? 

In a study designed to answer some of these questions, the 
subjects operated a stick type control. This control was so 
arranged that varying degrees of pressure could be exerted 
with very little movement of the control device itself. After 
some training and practice in"reproducing" various forces, 
a series of trials was attempted by each subject. Measures 
of actual pressure exerted were then compared with the pressures 
that the subjects attempted to reproduce. The "difference limens" 
by pounds of pressure for the various types of controls are 
shown in Figure V- 7 . Since the difference limen is the average 
difference that can just barely be detected, two pressures have 
to differ by an amount greater than the limen in order to be 
detected as being different. In the case in question, it is 
shown as a ratio, specifically the proportion of the standard 
pressure (the one to be reproduced) that can just barely be 
detected. 
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Figure V-7 "Difference limens" for various control types 

It can be seen that the limen drops off markedly between 
6 and 10 lb, and that it becomes relatively constant beyond that. 
In more practical terms, the results mean that in attempting to 
reproduce pressures under about 5 lb or possibly 10, the 
errors are proportionately greater than they are for heavier 
pressures. If differences in pressures are to be used as a 
basis for judging the operation of control devices, the pressures 
used preferably should be above 5 or 10 lb in order that more 
accurate discriminations can be made. 

Pressure versus distance in feedback . In the operation of 
controls that involve a reasonable amount of displacement or 
movement of the control devices, the kinesthetic sense comes 
into play. There is some rather persuasive evidence that dis- 
ance of movement (based on kines thesis) is a better feedback 
source than pressure (based on tactual sense). Without going 
into this study in any detail, it may be said that the subjects 
operated a lever in a blind positioning task, with varying 
pressures to be overcome and with varying distances of movement. 

In general, it was found that the distance the lever traveled 
(detected through the kinesthetic sense) was a much better cue 
for positioning the lever accurately than was the amount of 
pressure to be overcome. Positioning errors were greater 
for short movements, however, than for long movements. 
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In designing controls that are to be operated by "feel"* 
it then seems desirable to provide as much distance for movement 
as can be conveniently exercised. No particular pressure then 
needs to be provided. If a control is to be moved over a 
reasonably short range, however, pressure cues may be very 
useful. 

The conclusions that pressure cues may be more useful for 
short movements than for long movements is confirmed by another 
study in which an "arm control" was used. This control consisted 
of a lever type of device on which the forearm could rest in 
a horizontal position beside the subject. The control was 
pivoted under the elbow, and had a knob to grasp at the hand 
end. The control could then be rotated to the side. The sub- 
jects were instructed to make rapid positioning movements 
to three angular positions, namely, 17.5 , 35 , and 70 , and 
return. 


Various torque relationships were introduced into the 
system. In some cases the torque was constant from beginning 
to end, and in other cases it increased throughout the movement. 
The combinations of torques used (in inch-pounds) are given 
in Table V-5 . 


At beginning 

At terminal 

0 

0, 50, 100, 200 

25 

0, 50 

50 

50, 100 

100 

.50, 100 

200 

200 


Table V-5 Torque Relationships 

The results, summarized in Figure V-8 indicate that changes 
in torque (increases in torque as the movement continues) aided 
in accurate positioning for the short movements (the angular 
excursions of 17.5 and 35 ) but not for the longer movements 
(70°). 
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Figure V-8 Average Error in Degrees 


Summary 

1. When an operator is seated, the relative strengths of 
arm movements in various directions, in descending order, are 
push (horizontal), pull (horizontal), up, down, in, and out. 

The strength of arm movements is related to the position of 

the upper arm as follows: (a) Push and pull movements are some- 

what stronger when the upper arm is extended forward (at an 
oblique angle or straight ahead) than when it is down to the 
side; (b) up and down movements are somewhat stronger when the 
upper arm is at the side; and (c) the strengths of in and out 
movements are not markedly related to arm position. 

2. Greater strength can be exerted in a pulling action 
from a seated position if the direction of pull is upward from 
an oblique angle of about 45 than if the direction of pull 

is horizontal. Strength of upward pulls, however, is related 
to height of the lever grip, a low level (6 in below seat level) 
being better than higher levels. 

3. Greater strength can be exerted in a pushing action 
from a seated position if the feet are placed forward with the 
legs at an oblique angle than if the legs are at right angles 
to the floor. 
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4. In a horizontal pushing movement, greater strength can 
be exerted straight ahead than at an angle to the side, 

5. The strength that can be exerted in a standing position 
depends upon the position of the hand and the direction of move- 
ment (see Figure V-5 ). For above-shoulder levels, maximum 
force can be exerted ’with a downward pulling action. For most 
hand positions and movement directions below shoulder levels, 
force is greater at about 30 in below shoulder level than at 
about 18 in below. 


6. Hand -grip strength and endurance are correlated to a 
considerable degree. (Correlations for one sample were .67 
and .66 for right and left hands, respectively.) 

7. In hand-turning action, exertible force is related 
to hand position and direction of turn. For a pronation 
(turning- in) direction of turn, force is greatest when the 

hand is at a turned-out position; for a supination (turning-out) 
direction of turn, force is greatest when the hand is at a 
turned -in position. 

8. In elbow movements, a flexion action (bending) is con- 
siderably stronger than an extension action (straightening). 

The flexion force is maximum with the elbow bent at about a 
right angle. 

9. A shoulder action is generally stronger than an elbow 
action. In a seated position, shoulder estension (an upward 
push) is more forceful than flexion (a downward pull). 

10. In activating lever- type control devices, reaction 
time increases when the resistance in the control device is 
increased. 


11. In the operation of control devices such as levers, 
wheels, and pedals, differences in pressure can best be dis- 
criminated when the pressures are between about 5 or 10 lb 
and 30 or 40 lb. Discriminations of pressure differences 
less than 5 or 10 lb. 

12. When control devices such as levers are to be moved 
some distance, distance of movement generally serves as a better 
cue for accurate operation than changes in pressure. With 
short movements, however, changes in pressure improve accuracy 
of operation. 


\T~ 22 



RELATIVE TRACKING ERROR 


4. Controller Deadspace and Backlash 


The data and text in this section was extracted from the 
"Bioastronautics Data Book" NASA SP-3006 and "Human Engineering" 
by E. J. McCormick. 



Figure V-9 Controller 



0 1 2 

b. DEADSPACE - degrees 

Nonlinearities 


In most physical systems, the intended relationship between input 
and output is often complicated by the presence of nonlinearities 
such as friction, stiction, backlash, and deadspace. In a con- 
trol system with a human operator, these nonlinearities act 
to degrade performance. The curves above show the extent of 
degradation as a function of amplitude of two nonlinearities, 
deadspace and backlash. Deadspace is a range of input. In 
general it exists at only one position in the input range, 
ordinarily the center. Backlash is a deadspace that moves with 
the input, being encountered with each reversal of direction*. 
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Figure V- 9a shows the integrated absolute tracking error 
relative to that with zero backlash for various values of gain 
in the controlled system (longitudinal short period dynamics 
of the Northrup F-89 interceptor). 

Figure V-9b shows the increase in time off target relative 
to that for zero deadspace. The controlled system was an ex- 
ponential lag with 0.125 second time constant. The curves are 
labeled with the values of gain in the controlled system. 

In both cases, the controlled system and the variable dead- 
spa.ce or backlash were generated on an analog comauter. The 
actual control sticks used were spring loaded to reduce back- 
lash and deadspace to negligible levels. 

5, Motor Activities 


In the performance of human motor activities, certain po- 
sitions, angles, directions, speeds, or other conditions are 
"optimum” interms of human performance. Degrees or levels 
of such variables that are greater than, or less than, these 
optimums typically result in poorer performance. The following 
is a summary of data and studies reviewed in the area of human 
motor characteristics: 

1. The various types of sensory nerves serve as sources 
of information to the central nervous system. The motor nerves 
are the pathways through which action signals are transmitted 
to the muscles. 

2. In some motor activities information about the progress 
of the activity is transmitted back to the central nervous 
system by the sensory nerves, to aid in continuing the activity. 
This is called "feedback". 

3. Fatigue reduces or stops the transmission of signals 
through the motor nerves. 

4. Motor activities can be grouped in the following 

classes: (a) positioning movements; .(b) repetitive movements; 

(c) continuous movements; (d) serial movements; and (e) static 
reactions . 

5. Simple reaction time is the time required to respond 
to a single stimulus (signal). Complex reaction time is the 
time required to react when a discrimination; must be made from 
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among various stimuli. 

6. Long movements can be made in proportionately less 
time in relation to length than short movements. 

7. Movements terminated by mechanical devices take less 
time than those which are terminated exclusively by visual cues. 

8. Inward or outward visually controlled positioning 
movements are slightly faster than lateral movements, and 
right-to-left lateral movements are slightly faster than left- 
to-right . 

9. One-handed visually controlled positioning movements 
are performed best in terms of combined accuracy and speed 
when at about 60 angle right from a straight-ahead position, 
and when they are reasonably short. 

10. Two-handed positioning movements made simultaneously 
are slightly faster at approximately 30 angles right and 
left from a straight-ahead position, and are distinctly most 
accurate straight ahead (0 angle). 

11. In executing blind positioning movements, people tend 
to overshoot long distances. With vertical movements from 
top to bottom there is a tendency to overshoot both short and 
long movements. 

12. Continuous movements in a horizontal plane are most 
accurate in the directions represented by the 1:30 and 7:30 
o* clock positions. 

13. In serial movements consisting of travel and manipu- 
lation actions, travel time is affected by the nature of the 
manipulation task. 

14. Maintaining static posture is generally more 
fatiguing than some kind of ad jus tive posture. 

15. Tremor can be reduced by (a) use of visual reference; 
(b) support of body or body member, (c) having hand near heat 
level; and (d) having moderate friction in devices used. 

16. In a two-dimensional setting task with a joy stick, 
performance is most rapid when the tip of the joy stick moves 
2.5 or 3.0 times the distance of the target. Length of lever 
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or joy stick is of little importance if the optimum ratios 
are maintained. 

17. A moderate amount of inertia improves the smoothness 
of tracking operations. 
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B. CONTROLLER DESIGN EVALUATIONS 


Four candidate controller configurations were studied 
during this program and are described below. 

a. Bilateral 6-DOF Position - This configuration is gen- 
erally thought of as a 6 -DOF single controller in which the 
controller grip position, in its movement volume, relates to 
the manipulator TD position. Bilateral relates to a dual con- 
trol loop between the controller and the manipulator. A 
command signal is sent from the controller to the manipulator 
and the dynamics of the manipulator are reflected back to the 
controller for an electrically induced operator "feel". Hence, 
the terms "force reflection" or "force feedback" are applied 
to a bilateral position controller. This configuration is a 
non-replica controller in which each controller joint movement 
does not necessarily relate one-to-one with the corresponding 
manipulator joint movements. This controller "flies" the mani- 
pulator terminal device (TD) as though it were a free flyer. 

A variety of controller to TD movement ratios can be utilized. 
Ratios from 1:1 to 30:1 appear operationally feasible. Since 
low movement ratios will require gross controller movements, 
in excess of control station volumes and the operator's arm 
length, indexing becomes necessary. Indexing allows the con- 
troller to be electrically disconnected from the manipulator 
system and be repositioned to any point the operator wishes in 
the movement volume. The concept is similar to a ratcheting 
wench. Indexing is done for both position and attitude reposi- 
tioning. 

Bilateral position controller type manipulators have been 
used for years, for handling radioactive materials. These con- 
trollers are generally mechanically linked (tape drive) to the 
manipulator which provides force reflection. Electrical and 
hydraulic systems are also available. However, all of these 
manipulator systems have one thing in common. The controller 
must be an exact replica of the manipulator and a single, fixed, 
movement ratio between the controller and the manipulator is 
determined by the controller size. 

A 6 DOF bilateral position controller, as invisioned for the 
Shuttle manipulator system, with indexing and variable control 
ratios, is a developmental item. 


V-27 



b. Unilateral 6-DOF Position - Unilateral relates to a 


single data flow, from the controller to the manipulator only. 

The controller can be an identical design to the bilateral 
type as far as indexing and control ratios, except there is 
no force feedback. The controller can be limp, completely 
free to move, however, this is a totally unacceptable mode from 
an operator's standpoint. This can be demonstrated on the 
CAM 1400. The operator can "get ahead" of the manipulator 
and then prediction of where the TD will go is difficult. Arm 
and muscle induced git. ter is noticeable with a limp controller. 

The second mode for a unilateral controller, is one 
with artificial feel induced* This type was used in our 
man -in- the- loop dynamic simulations. It was as close 

as we could get to a true bilateral system at the time. 

Artificial feel can be induced by driving servo motors in each 
of the controllers joints. The force can be constant or pro- 
portional to the commanded manipulator velocity. 

c . Geometrically Similar Replica - The replica controller 
is simply a miniature of the manipulator. Joint for joint it is 
identical. For laboratory work this concept is acceptable 
since the manipulators movement volume is generally small and 
the system can be designed around a specific task. However, 
for the Shuttle manipulator system a replica controller has 
some serious drawbacks. First, the replica can have only one 
movement ratio which is dictated by the size ratio between the 
controller and the manipulator. For example, with a 50 ft 
manipulator and an operator with an average arm length of 28", and 
ratio 20:1 seems reasonable. This dictates a controller 
approximately 32 inches long which must have free movement 
volume at the operator’s console in a 64 in dia half sphere 
from its mounting base, which is significant from a crew 
station volume standpoint. Larger single control ratios, 
such as 30 or 40:1 which make the controller smaller, make 
vernier manipulator control difficult. 

The lack of an "indexing" capability grossly affects 
operator performance. Our simulations show indexing is done 
as much or more for controller attitude corrections than for 
translational corrections. Most manipulator tasks require long 
translations with attitude changes along the way and then ver- 
nier attitude and translations at, for example, a work site. 

With a replica controller this generally means the operator’s 
arm is extended at some odd angle and the wrist is bent around 
in an uncomfortable position. This grossly degrades operator 
performance. 
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d* 6-DOF Rate - This control configuration utilizes two 
3-DOF Apollo type controllers. There is no force feedback. 

The TD of the manipulator is "flown” as though it were a free 
flyer and there is no direct interaction between the controllers 
and the manipulator joints. The right hand controller commands 
attitude changes of the manipulator wrist and the left hand 
controller commands translational changes at the TD. Both 
controllers must be proportional type. This means the commanded 
angular or translational velocity of the manipulator is propor- 
tional to the displacement of the controller grip, up to the 
manipulator’s maximum velocity. The Apollo controller cannot 
be used for manipulator control, as-is. Both are designed for 
pressure suit operation and the "feel" characteristics should 
be changed. The attitude controller is a proportional type, 
however, the translation controller is not. It is simply an 
on-off type and would have to be redesigned if used. Rate 
controllers do have the advantage of allowing the attitude and 
translation commands to be singled out in separate controllers* 
No one is sure the rate controllers can control the manipulator 
adequately for the proposed tasks, especially where rapid non- 
uniform attitude changes are required such as capturing a rota- 
ting, nutating satellite. There is also, no direct feedback 
to the operator to indicate hitting an object or how much 
force is being applied to a task. However, force information 
can be given to the operator visually, with meters and lights. 
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Master Controller Configuration Alternatives (Joint Ordering) Analysis 

a. Introduction - The AMS master controller configuration 
must be commensurate with a restricted control station volume, 
while at the same time maintaining the customary isotropic ity 
and uniformity of the friction inertia and feedback forces. 

In commercial bilateral force reflecting manipulators, both 
in the articulated and the telescoping motion varieties, moment 
arms are kept sufficiently uniform by restricting motion ranges. 

In the majority of devices, moment arms in any direction will 
vary less than a factor of two from minimum to maximum. Friction 
and feedback forces at the TD are inversely proportional to these 
moments ratios, while drive train inertias are inversely pro- 
portional to the square of them. The result of this approach 
is often a quite large manipulator master which is not suitable 
for Shuttle applications. Even the smallest of the presently 
existing bilateral manipulators , the Brookhaven National 
Laboratories (BNL) arm, is too large for this applications. 

In fact, a thorough and fundamental study of master con- 
figurations has never been made as existing devices lean strongly 
on mechanical through the wall master slave configurations, which 
by their very nature of application are constrained to a relatively 
small selection of possible motions. 

b. Procedure - For ease of analysis wrist motions can be 
separated from translational motions. Wrist motions are assumed 
to consist of three orthogonal rotations in a sequence adapted 
to the chosen translational motions such as to minimize motion 
singularities . It is then sufficient to examine the properties 
of the translational DOF. 

An attempt will be made to formulate the beginnings of 
selection rules that will systemize the search and assure as much as 
possible that no possibilities are overlooked. To ease the dis- 
cussion of the many configurations possible a short hand notation 
is used. For rotational motions the familiar terms P (pitch), 

Y (yaw), and R (roll) will be used starting from the motion fixed 
to ground and proceeding toward the terminal device (TD) . Thus the 
master shown in FigureV-lOa and b would be (Y-P-P)^ (Y-P-R) R 
which would read (yaw-pitch-pitch) for translational motions, 
(yaw-pitch-roll) for rotational motions. A sliding motion is 
designated by S , S , or S^, where the subscript designates 
the direction o¥ thi slides which is taken to be along the axis 
of rotation of the subscript rotational motion. Thus the 
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prototype would be (S -Y-P) (Y-P-R) . 

K 1 R 

All configurations will be examined for the following 
criteria : 

1. Capability of true three dimensional motion 

2. Absence of motion singularities or motion redundancies 

3. Force uniformity and isotropicity 

4. Magnitude of offset forces 

5. Coverage of required volume 

6. Interface with operator configuration 

7. Interface with shuttle cockpit configuration 

8. Weight and complexity figure of merit 

9. Low inertia configuration 

Failure to meet criteria 1 and 2 will result in immediate 
rejection of configuration a procedure which will probably 
leave a manageable small number of configurations to examine. 

Candidate Configuration Selection 

a) Three rotational DOF. 

Of the 27 ways three variables can be permutated, a great 
number can be discarded easily. (This incidentally leads to the 
beginnings of motion selection rules). 

1. Use of the same motion three times in succession is 

excluded. Reason: All three varieties lead to 

singularities and P-P-P as well as Y-Y-Y result in 
planar motion. 

2. Two successive R's result in singularity and are ex- 
cluded. (Eliminates R-R-Y, R-R-P, Y-R-R, P-R-R) 

3. R-Y-R and R-P-R are constrained to move on the surface 
of a sphere and therefore have not true three dimen- 
sional motion. 
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4. Each of the six double Y configurations is equivalent 
to a double P configuration rotated by 90 . More or 
less arbitrarily we will examine only the double P 
configurations for criteria 1 to 4 and may rotate back 
to double Y configurations if criteria 5 to 7 favor 
it. 

5. Of the six remaining double P configurations P-P-Y 
and P-P-R seem not suitable as they lead to frequent 
singularities with any possible wrist configurations. 

(It looks like the motion closest to the wrist wants 
to be a P) . 

6. Of the remaining four double P configurations we have 
Y-P-P, the configuration shown in Figure V-lOa & b 

as well as that of the BNL arm. R-P-P is the BNL 
arm configuration with alternate mount orientation and 
P-R-P is the NAL E-2, E-3, E-4 configuration. These 
three should be examined further. The remaining 
P-Y-P may also be a candidate if the first P and Y 
axis are made to intersect. 

7. Of the six configurations containing one each of P, 

Y, and R, the four not having a P closest to the 
wrist should be eliminated since they form singulari- 
ties with wrist motion as in point 5. 

8. Both the remaining Y, R, P and R, Y, P are not truely 
three dimensional as the wrist point describes a sur- 
face but is incapable to cover the interior volume. 

b) Three DOF with Slides. 

1. All slides must be orthogonal 

2. The six possible three slide configurations are iden- 
tical as far as criteria 1 to 4 are concerned. The 
arrangement to be chosen will be governed by the 
remaining criteria. 

3. S configurations may not contain an R. R-S-S and S-S-R 
are not three dimensional and S-R-S alters the slide- 
slide or thogona lit y . 

4. There is a Y-P similarity again so that only P-S-S, 
S-P-S , and S-S-P need to be considered. 
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5. The 18 configurations which combine one slide with two 
similar rotational motions are either planar or have 
singularities . 

6. The 18 configurations which combine a slide with two 
different rotating motions contain 10 configurations 
that do not have a S or P as a last motion before 
the wrist. These lead to singularities with the 
wrist and are eliminated. 

7. The remaining eight single slide configurations must 
be examined further. 

Out of 78 configurations examined, the following 16 remain: 


P-Y-P, 

P-R-P, 

Y-P-P, 

R-P-P, 

S-S-S, 

P-S-S, 

S-P-S, 

S-S-P, 

s y -r-p, 

s y -y-p, y-s y -p. 

R-S-P, 

y-p-s y . 

Y-R-S y , R-Y-S r , 

R-P-S y , 


Further examination of the single slide configuration 
reveals the following: 

Y-R-S^ is really planar. 

R-Y-S^ is sequentially planar, that is all points in its volume 
can be reached but in general a linear motion between arbitrary 
points cannot be described by the wrist point. 

R-S-P it is seen that a direction cannot be assigned to the slide 
as it changes with the position of R. This configuration is 
also sequentially planar. 

Further reduction in the number of configurations acceptable 

can be made by considering volume covered to volume occupied 

(V /V ) ratios. The only reason rotating joints have been 

in£rocfuced to manipulator configurations is because in general 

they have a much better V /V ratios. There are however 

c u 

some specific exceptions where slides are acceptable. 

1. Slides that can be executed by use of telescoping 

tubes give reasonable V /V if they are the last motion before 

cu 

the wrist, (Many mechanical master slaves use this). 
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2. For specific space configurations pseudo-slides can be 
attractive. These are rotating joints with very long moment 
arms allowed to travel through a small angle, and therefore have 
good linearity. Pseudo-slides are generally only useful if 
they are the first or the first and second motion, A pseudo- 
slide following a rotational motion leads to control difficul- 
ties on the latter. This eliminates Y-S -P. In the narrow 
control volume of the shuttle, substituting a pseudo-slide for 
Sy does not seem feasible nor does a true Sy, thus eliminating 
S -R-P and S -Y-P. So, of the one slide mechanisms only 
Y-P-Sy and R-P-Sy are left. 

Looking now at the two-slide mechanisms we eliminate P-S-S 
since a middle slide is not suitable for a speudo-slide. 

In S-S-P one S must be an S , which is a pseudo-slide, and 
not attractive in the shuttle volume. S-P-S can only be 
accomplished if the last slide is a true S y which requires the 
first one to be an Sp done as a pseudo-slide. 

The three-slide configuration is a possibility with the 
first two as pseudo-slides and the last as a true Sy, This 

S -S _-S . However, as pseudo- 
identical ball joints. At this 
to change notation and describe 
pseudo-slides as long rotational motions. So that if the 
pseudo-slides motions we have left are: R-.-P-S , or 
P l -R l -S y , and R^-P-Sy. We now notice that or the four motions 
left involving slides or pseudo-slides three are R-P-Sy, 
RL-'P-'Sy,and that differing only by moment arm 

length. But the length of moment arm which we are free to 
adjust is the length of the telescoping arm. This moment 
arm wants to be as long as possible anyway in order to be able 
to cover vertical motion with a minimum of moment arm variation 
in R and P. We then arrive at R^-P -S as one possible final 
candidate. Roll (Long Moment Arm Simulating a Slide) - 
Pitch (Long Moment Arm) - Slide (Along the Yaw Axis Vertical). 

While intuitively the other five remaining motions do not 
look nearly as good as R^-P^-Sy it is worthwhile to make the 
final selection after comparison for force uniformity and 
isotropicity. 

Uniformity and Isotropic ity of Forces 

The entire group having rotational motions only has a 
common feature of two P motions either in succession or 
separated by another rotational motion. In order for these 


couLd oe done as b p -b -b or 
slides Sp-S R and S^-S^ are 
point it might be worthwhile 
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articulated configurations to fit and be capable of 

maneuvering in the A defined shuttle control space the arms 

between the P joints must remain quite short, 1.2 n . Yet in 

order to cover the desired control volume it is necessary to 

o o 

let the included elbow angle vary from 15 to 150 . Without 
analyzing all the possible positions showing force anisotro- 
pic ity, the top hand position of f igureV-10 was evaluated. In 
this position the moment arm for up and down motion is approxi- 
mately 1/10 that for fore and aft motion. That means that for 
the up and down motion friction is about 10 times nominal friction 
force, feedback forces are 10 times too high (80 lbs), and 
inertia forces due to shoulder actuator and drive train compo- 
nents are 100 times the nominal ones. Yet these same components 
are quite near nominal for fore and aft movements. While only 
one example has been detailed, things are nearly as bad for 
some other TD locations. This is highly undesirable. 

At this point, the configurations left for consideration 

are : 

1. A family of four configurations having rotational joints only. 

2. A group of configurations which converged to P^-R^-Sy. 

3. Y - P - S y 

It is possible to eliminate the Y - P - Sy configuration 
as in some positions it has no lateral displacement as well 
as allowing zero moment arms on the Y motion right in the 
middle of the covered volume. 

The remaining two families are R^-P^-Sy and Y-P-P. As 
can be seen the R^-P^-Sy configuration has much better force 
uniformity and isotropicity than the Y-P-P family. Furthermore, 
all three shoulder actuators can be located near the cockpit 
floor yielding a low inertia configuration with nearly 
stationary actuator packages. If cockpit configuration allows, 
these actuators might even be located below the cockpit floor 
even further reducing force ratios. 

The price to be paid for this is slightly larger weight 
due to the long telescoping tube and the somewhat larger gear 
ratios required for the R and P^ motions. Since the vertical 
boom never is more than afeout 17 from the vertical no 

large unbalance occurs on the master. If necessary even this 
can be further improved by simple means. Also, when used for 
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Figure V- 10a Elbow Type 6 DOF Position Controller 
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Figure V-lOb Elbow Type 6 DOF Position Controller 
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one "G" simulation, no counterbalance is needed for the pitch 
and roll at base. 

An appropriate wrist configuration for the IL -P^-S 
configuration seems to be Y-P-R. This can be achieved in a 
well balanced arrangement as no vertical arm exists to cause 
operator elbow interference. 

The configuration of R^-P^-S^ is shown in figures V-ll a and b. 

This master is also suitable for rate control experiments. 

By limiting motion to approximately 1 inch in R, P, and S 
and center-zero spring loading these motions, what looks like 
a very suitable rate control master is created. 
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Figure V-llb 6 DOF Vertical Slider Position Controller 
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Man-In-The-Loop-Simulations 

Simulations were performed in Martin Marietta's Space 
Operations Simulator (SOS) facility, a six degree-of-freedom 
(DOF), moving base, servo controlled motion generating 
system. The simulations were divided into two phases, corres- 
ponding to two types of Shuttle tasks: Phase I, payload 

tracking and capture and Phase XI, payload retrieval and cargo 
bay stowage. In the first Phase the task was primarily one 
of tracking the target receptacle with the terminal device, 
although the TD was actually inserted into the receptacle 
during a run. However, physical capture or contact dynamics 
were not simulated. The Phase II task consisted of first 
translating and rotating the captured payload to a position 
near, and aligned with, the cargo bay, and then maintaining 
alignment while lowering the cargo into the bay. The task 
was terminated when two pins on the cargo were seated into 
two receptacles in the bottom of the cargo bay. 

The modeled manipulator arm had the following characteris- 
tics: two main segments of length 25 ft each, wrist length 

of 2 ft, and gimbal sequence of yaw, pitch at the shoulder, 
pitch at the elbow, and pitch, yaw, roll at the wrist. The 
arm shoulder is assumed to be attached to the Shuttle at the 
forward right corner of the Cargo Bay. For this simulation, 
the TD television camera is placed "outside 11 the 3 wrist 
gimbals; i.e., so that the 3 gimbals are between the camera 
and the elbow. 

The control laws derived for the simulations have the 
following features: (1) coordinated translational and rota- 

tional control, (2) rotations about any point, (3) positional 
and rotational indexing, (4) automatic tip attitude hold 
(hawk mode), and (5) multiple gain ratios for translational 
motion-. Both rate and position type control systems were 
developed so that in the simulations a good operational compari 
son between the two could be made. 

The two most important relative motion effects were 
included in this simulation: target flyby velocities , and 

terminal device motions due .to the commands sent to the 
joint servos. The servos were accurately modeled to include 
their response characteristics when accelerating and decellera- 
ting for presently conceived arm joint designs. Two models 
were developed, one for the tracking task (essentially no load) 
and one for the cargo stowage task (65,000 lb load). 
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Past simulations have shown that the other relative motion 
effects, due to Shuttle limit cycles and arm flexibility, do 
not greatly effect the operator’s control for the joint 
torques used in the simulated arm model. It is believed that 
not including these motion effects in this simulation did not 
change the basic conclusions drawn concerning unilateral 
position systems. 

Input commands from the controller are sent to the hybrid 
computer facility (EAI 8900), which is programmed with the 
control laws, manipulator arm models, and other equations or 
logic required by the simulation. The computer calculates the 
commands for the SOS servo motors which produce proper relative 
motion between the viewing camera and the task mock-ups in 
all 6 degrees-of-freedom (DOF). Video information from the 
cameras is then sent back to TV monitors on the operators 
console. 


Over 100 runs were made using the SOS facility with 
parameter variations covering control gains or ratios, target 
velocities, control modes and different input controllers. 
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Position Controller Design Evaluations 

The goal of this evaluation phase is to evolve a bilateral 
position controller configuration which would be built into an 
operational model. Our goal at the time was to come up with 
an acceptable tool which would have interchangeable parts to 
allow a wide variety of manipulator configurations to be 
evaluated . 

The first step was to construct several wood/metal con- 
troller mockups Figure V- 12 ? to derive criteria on segment lengths, 
joint ordering, movement volumes and controller attach points 
in relation to the operator. At this point in the evaluation, 
the elbow controller was a prime contender. Emphasis was 
placed on joint ordering, particularly for attitude control. 

Figure V- 13 shows movement volumes associated with this type 
of controller. It was thought, at the time, that large move- 
ment volumes would be desirable, which our simulations proved 
incorrect. If an elbow type controller was desirable with a 
"stacked" or unbalanced gimbal attitude control then the 6-DOF 
configuration shown in Figure V-14 is the most desirable. This 
gimbal order, starting at the grip, is pitch, yaw, roll, pitch 
at the elbow and yaw and pitch at the shoulder. 

A functional model of this configuration was constructed 
of aluminum and steel with pots on each joint (Figure V-14) 
to further evaluate this concept. The segment lengths are 
variable and each joint is interchangeable. This model is 
described in detail in Appendix B. Various configurations 
of the operational elbow controller were evaluated against a 
simulated manipulator tracking and alignment task presented on 
a stereo color TV system. The stereo system is described in 
Appendix C, however, it is essentially a 5 DOF dot and cross- 
hair tracking task which did provide a dynamic evaluating tech- 
nique to test controller characteristics against. It was deter- 
mined that gimbal "stacking" for attitude control was a poor 
design since it produced cross-coupling between the attitude 
gimbals themselves and also between the translation gimbals. 
Because the gimbals are stacked and the drive motors are large, 
several inch long lever arms exist between upper and lower 
gimbals. Gross hand/ arm movements were also required for 
attitude control. It became obvious a better manipulator 
design was required. A second, significant problem exists 
with an "elbow" type controller. This relates to the "toggle" 
effect. As the elbow angle changes, the force required to 
backdrive the joints changes significantly. Figure V-15 
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Figure V-12 Controller Mockups 



Figure V-13 6-DOF Elbow Type Controller Movement Volume 
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Shoulder Angle (8) 

Figure V-15 Replica Stiction Force Ratio 


shows this force relationship for a typical replica. It can 
be seen that for a force ratio of say 4 or less, the Q must 
remain between 45° and 75°, an undesirable restriction. If 
larger angles are used the backdriving force variations can be 
misinterpreted as real manipulator tip forces by the operator 
in a force reflecting system. 

The next major position controller configuration concept 
to evolve is called the "sliding base" and is shown in Figure 
V-16. The pitch and yaw attitude gimbals are balanced at the 
operator’s wrist. Roll is balanced on the center of the grip. 

Y and Z translation is controlled by two gimbals attached to 
a sliding mechanism which controls X translation. This con- 
troller was configured into a fully operational, force re- 
flecting system which was used as the primary position con- 
troller during our dynamic simulations on the Space Operations 
Simulator. The controller is counterbalanced so the operator 
does not have to hold the weight of the mechanism against 
gravity. 

Extensive use of this controller configuration resulted 
in several significant conclusions: 

1. The force feedback levels could be varied between 0 
and approximately 16 lbs. The full gammit of maximum force 
levels was tried from very limp to levels in the 10 to 16 lb 
range. It was found that for typical tracking tasks, levels 
up to 2 lbs were too light. Since the operator’s arm is not 
supported, muscle tremmor and jitter were pronounced at the 
low levels. Vernier movements were difficult. It was found 
that the operator needed a force feedback in the 3-5 lb 
range, depending on the position of the operator’s arm in 
relation to his body and the direction the force is applied. 
Higher forces 8-12 lbs quickly fatigued the arm and some 
operators resorted to using two hands to accomplish the track- 
ing tasks at these high force levels. 

2. This gimbaling concept, allowed cross-coupling be- 
tween the pitch/yaw gimbals and X/Y translations. The extent 
of the cross-coupling varied with the force levels selected 
at the various joints, however, it was always present to some 
extent. This is caused by the moment arm resulting from con- 
troller grip being offset from the pivot point by approximately 
4 in. The coupling went both ways, between attitude and 
translation, and translation and attitude. For example, if 

a straight Y translation was commanded by pushing the controller 
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Figure V-16 6-DOF Sliding Base Position Controller 








to the left or right, some portion (depending on the operator’s 
awareness and ability to compensate) of that input would 
result in a rotation about the yaw gimbal axis. The same 
thing happened for pitch and Z translation. The obvious 
solution to this problem is a grip balanced attitude control 
as shown in Figures v-17aand V-i7b. This configuration places 
all 3 of the attitude pivot points through the center of the 
grip, thereby, eliminating attitude control induced moments 
on the translational gimbals. 

3. The sliding base concept, for X direction commands, 
was poor. For straight X commands, the mechanism worked well. 
The problem arose, when a large translational offset was 
created by commanding a large Y or Z translation. This 
rotated the forward arm of the controller off at some sig- 
nificant angle in relation to the sliding mechanism, 45 to 
60°, X translation became difficult to control at or near 
these angles. As can be seen from Figure V-18 the control 
grip has shifted significantly off its plane of travel which, 
not only creates coupling between X and Y but the force 
required to position the slider varies with the angle of the 
upper arm segment. As the angle of the upper arm segment in- 
creases, combined X and Y/Z translations become more difficult 
to command. , 



Figure V-18 Sliding Base Controller, Top View 
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4. At the onset of our controller evaluations we 
assumed indexing the controller, during a dynamic task, would 
be difficult and distracting. This assumption was incorrect. 
Even with the inertia created from the counterbalance weights, 
indexing the controller became an automatic reflex, similar 

to shifting a car. Indexing was accomplished by pressing a 
small button on the controller grip which electrically dis- 
connected the controller from the manipulator control elec- 
tronics. While the button was depressed, the controller 
could be quickly repositioned to any point in its movement 
volume that the operator selected. 

The manipulator was engaged to the control electronics 
by releasing the button. Indexing times ranged from 1 to 2 
sec depending on the movement involved. Indexing was required 
as much, or more for attitude correction as translation. 

Most operators indexed the controller at a convenient time 
during the task, rather than waiting until the controller at 
a convenient time during the task, rather than waiting until 
the controller was fully extended. The operators also pre- 
ferred to keep the control grip close to the body which kept 
the operator’s arm in a more comfortable position. This 
allowed for more precise movements and less atm fatigue. 

5, The combination of indexing capability and a variety 
of control ratios allows the operator to work the position 
controller in a rather small volume (approx. 4 cu ft). The 
control ratio is the displacement ratio between the manipulator 
tip movement and the position controller movement. Ratios 
from 30; 1 down to .5:1 were evaluated for tracking and cargo 
handling tasks. For tracking tasks, where the target velocity 
was .25 ft/sec, a high and low ratio was found necessary. The 
operators were allowed to select the ratios they wanted and 
most found 20 or 25; 1 desirable for the high or gross movement 
tasks and 6 or 8:1 for vernier, close in, capture tasks, A 
medium range of 10 to 15:1 was used until the operators be- 
came proficient at the task and then it was dropped in favor 

of a single high/ low ratio combination. During a dynamic track' 
ing task, a 30; 1 control ratio tended to produce very quick, 
erratic responses at the manipulator tip. Any extraneous 
arm or muscle tremor was unnecessarily amplified. Unless 
specifically requested, none of the operators used or wanted 
a ratio above 25:1. Vernier movement, while tracking at the 
same time, is readily controlled in the 6 to 8:1 range. 

Lower ratios require too many indexes and disrupts the track- 
ing continuity. 
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6. The primary mode of operation, during the simulations, 
was to stop the manipulator tip travel during a controller 
index. Since the indexing sequence took place very quickly, 
this did not present a problem. However, it was decided to 
evaluate the same tracking tasks and allow the manipulator 

tip to continue on at the velocity commanded just before 
indexing. For close-in tasks, this mode is disaster ous. Dur- 
ing several runs, the target was inadvertently hit before con- 
trol was regained, which never happened when the tip was stopped 
during indexing. Allowing the manipulator to maintain a velocity 
may be desirable while moving large payloads or for gross, un- 
loaded, maneuvers where the tip is not near an obstacle. It 
may be desirable to give the operator the option to select 
whether tip velocity is maintained or not during indexing. 

Further simulations are required. 

7. The controller interaction with the visual system is 
critical. The visual scene used for control of the task must 
be aligned with the controllers movement axis. For example, 
the X movement of the controller, fore and aft, must move the 
TD in and out of the picture. Slight, consistent, off-axis 
situations can be learned and compensated for, by the operator, 
with a corresponding small degradation in task performance. 
However, any gross axis misalignment or especially an incon- 
sistent misalignment, makes many tasks nearly impossible. The 
operator resorts to a frustrating, guessing game where some- 
times he is successful and many times not. No consistency is 
experienced, however. 

8. In a position system, the operator derives tactile 
and kenisetic feedback relative to the commanded manipulator 
tip velocity. The operator's sensory capability is not keen 
enough in the low force levels 1-2 lbs. to accurately determine 
the specific velocity he is commanding. Primarily, the opera- 
tor needs to know when he is commanding near or at maximum tip 
velocities. This could be done through the controller by 
having a step function force increase when an command exceeded 
the manipulators capability. However, this method would in- 
crease the controllers motor sizes significantly since a 
rather sizable force is needed. Another approach, which we 
employed successfully, was to place two warning lights above 
the operator's TV monitor. A yellow light comes on when 75% 
of the maximum tip velocity was commanded. The red light came 
on when 1007o is commanded. Information feedback to the opera- 
tor at these two data points proved adequate during our sim- 
ulations. 
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C. RECOMMENDATIONS AND CONCLUSIONS 


The primary purpose of this section is to describe the 
rational for and recommend a bilateral master controller 
configuration. However, the controller is intimently tied 
to the total manipulator system characteristics. Therefore, 
the conclusions and recommendations will relate to not only 
the controller design but also to the associated desirable 
system characteristics. 

Recommended Controller Configuration 

The recommended controller configuration is shown in 
Figures V-17 thru V-19, The configuration has the following 
advantages and features: 

1. The attitude gimbals are balanced at the center of 
the operator's grip. This technique, when associated with 

a vertical sliding base, eliminates unwanted cross-coupling 
between the attitude and translation control inputs. Con- 
troller rotations rarely exceeded + 45° in any axis, before 
indexing. However, design limits should be + 90° in each 
attitude axis, 

2, Translation control consists of a vertical tele- 
scoping member attached to pitch and yaw gimbals at the base. 
This design is unique, when compared with the other concepts 
evaluated, in that the controller can be positioned through 
its movement volume and not build up unwanted forces unique 
to its position. Pure Z translations are made by positioning 
the controller straight up or down. X and Y (f ore/aft and 
right/ left) translations consists of a combination of the 
pitch and/or yaw gimbal, and the vertical telescoping member. 
The mass of the vertical telescoping member can be kept low, 
since all three translation drives can be mounted on the 
base. There are no lever arms in the attitude gimbals and 
these drive motors can be small. Controller mass is espec- 
ially important during indexing, when the unpowered controller 
is rapidly repositioned. A desirable movement envelope is 
created when the vertical slider has an upward movement of 

12 inches and downward of 6 in. This is measured from the 
operator's hand (forward) with the elbow bent 90° (about 
waist level), Th^ PSY base gimbal travel need not exceed 
+ 45° measured from vertical. 
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Figure V-17a 6-DOF Vertical Slider Position Controller Front Mounted 
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Figure V-19 6 -DOF Slider (Vertical) Bilateral Controller 






Figure V-17b 6-DOF Vertical Slider Position Controller Side Mounted 
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3, Mounting position of this controller concept is not 
critical. It can be floor mounted, from a bracket off the 
operator's console or from the operator’s restraint. It can 
be used in any position in relation to the operator, i.e., 
right or left handed or in the center. From an operator's 
standpoint and considering the present Shuttle design, a 
mounting position directly in front of the operator appears 
best. 


4. The control grip movement volume need not exceed a 
2 x 2 x 2 ft volume in front of the operator. The Y trans- 
lation dimensions need not exceed the operator's shoulder 
width. 

5. The operator should be in either a standing or 
semi-standing (knee's bent) position, A seated position 
interferes with the controller movement volume. 

6. The controller grip. Figure V-20 , should be a full 
sized pistol grip type, similar to those used in aircraft. 
Minimum size should be approximately 4-1/2 in. long with an 
oval cross-section measuring at least 1 x 1-1/2 in. The grip 
should contain several switches for system control. 


Those required are 


a. 

A rocker switch for terminal device 

opening and closing. 

b. 

Indexing push button. 


c. 2 or 3 position selector switch for 

pulator ratio select. 

eontroller/mani- 

Additional control may include: 


a. 

Camera pan/tilt 


b. 

Camera lens zoom 


c. 

Camera select 


d. 

Lighting 
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Figure V-20 Controller Hand Grip 


Recommended Manipulator System Characteristics 


A. As discussed earlier a range of manipulator/ controller 
movement ratios of 25:1 to 4:1 were found to be the most 
desirable from an operator's standpoint, and related to the 
tasks evaluated. Since these tasks were extremes, worst 
case, it is felt that these end points are accurate for the 
full gamut of manipulator tasks. 

B. The system must allow the controller to be indexed 
rapidly, to any position in the movement volume. 

C. Manipulator controller axis alignment with the visual 
system is mandatory. 

D. Two TV monitors are required for the operator. One for 
a detailed view and one for an overall scene. Switching 
cameras on a monitor during a specific task is distracting 
and undesirable. 

E. Unless stereo TV is used or a side view is provided, 
visual aids are required to aid the operator during alignment 
tasks and help determine positions in the X direction. Our 
simulations showed that a standoff cross was required to 
accurately position the TD in a receptacle. Various methods 
such as mirrors, perpendicular lines and vertical feelers were 
evaluated with some success. 
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VI. DYNAMICS 


There are two primary objectives for conducting a dynami- 
cal analysis of an Attached Manipulator System. The first is 
to gather basic design data such as the torque and load re- 
quirements associated with the various manipulator tasks, and 
the second is to obtain a mathematical description of the per- 
tinent dynamical (flexible body) phenomena of the AMS. The 
second objective is necessary for the control system design 
and any simulations or demonstrations of AMS dynamical be- 
havior. 

The AMS dynamics effort is divided into three parallel 
programs: (1) a generalized rigid body dynamics model to 

obtain the preliminary design data (torques and loads) for 
the AMS, (2) a vibrations analysis to study the mode shapes 
and frequencies of the AMS as it vibrates about a particular 
equilibrium position, and (3) a modification of a generalized 
n-body digital computer program previously developed by Martin 
Marietta, The third program is capable of simulating the 
flexible behavior of the AMS as the joints undergo large non- 
linear excursions and is being used to examine the interaction 
between the control system and the flexible arm. 

Section A of this chapter is devoted to the rigid body 
analyses including the development of the mathematical model 
and corresponding computer program. Results for a number of 
payload deployment tasks are presented, and these are used to 
arrive at the joint torque requirements for the AMS. 

Section B contains a discussion of two vibration analyses 
of the AMS along with results based on preliminary design data. 

Section C is devoted to the generalized n-flexible body 
computer program, and a simplified payload handling task is 
used to compare the rigid and flexible behavior of the AMS. 

Finally, the findings of this work are summarized in 
Section D along with some recommendations for future work. 
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A. RIGID BODY ANALYSIS * 

For purposes of obtaining load requirements and simulation 
facility design requirements, the AMS was modelled as six 
interconnected rigid bodies. Throughout the analysis, suffi- 
cient generality was maintained to arrive at a single set of 
equations describing both the Shuttle Attached Manipulator 
System (SAMS) and the earth-based Attached Manipulator System. 

To maintain continuity, the description of the generalized AMS model 
and a detailed derivation of the equations of motion are contain- 
ed in Appendix A. 

1. Computer Program 

The equations developed in Appendix A. constitute the main body of 
a digital computer simulation which is programmed to calculate 
pertinent design data associated with various AMS tasks. The 
utility of this program is best described in terms of its input 
and output. 

First, one selects the appropriate geometry and inertia 
properties describing a payload and either the SAMS or the 
AMS, Next, a particular task is chosen and included in the 
program by means of time dependent functions for the various 
joint angles. Finally, the user can specify any set of ex- 
ternal forces and torques acting on any or all the bodies in- 
volved (gravitational forces are automatically included simply 
by specifying the components of the gravity vector in inertial 
space). 

When the computer program is used to simulate the SAMS, 
the primary output consists of: interaction forces and torques 

acting on the SAMS, Shuttle, and payload; joint motor torques 
required to execute the SAMS task; and finally, the Shuttle 
motion which is induced by the SAMS task. By exercising the 
option to include external forces and torques (in particular, 
the ACS thrusters on the Shuttle) this program can easily be 
used to study the interactions between the Shuttle ACS and the 
motion of the SAMS, 

When the program is applied to the AMS, the output is the 
same as for the space version, with one exception: the motion 

of the Shuttle is replaced by the forces and torques acting 
on the ground-based support structure of the AMS, In this 
case, selection of appropriate external forces and torques 
(or simply by misaligning the gravity vector from the verti- 
cal), the computer program can be used to study the effects 

* The work presented in this Section was performed under In- 
dependent Research and Development Task No. D-05R entitled 
"Teleoperator Manned Control and Mission Simulation". 
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of perturbations forces due to imperfections in the simulation 
facility, such as floor slope or air bearing drag forces. 

2, Check Cases 


Before applying the rigid body program to AMS behavior, it 
was validated by means of several check cases. It was decided 
to divide the check cases into two groups; those not involving 
the presence of external forces and torques and those that do. 
For the first group of check cases, all but one of the gimbal 
angles of the AMS are held fixed and the remaining one is pre- 
scribed as a function of time. This results in (by proper 
choice of inertia properties) the planar motion of two inter- 
connected rigid bodies; the motion of one body relative to the 
other being prescribed. This relative motion of the two bodies 
will induce a motion of the second body relative to inertial 
space. The solution for this motion is known (see Reference 3), 
and with it, one can easily determine the joint forces and 
torques which are developed between the two bodies. Now it is 
precisely the computation of the motion induced in the Shuttle 
by the AMS prescribed motion and, with it, the computation of 
joint forces and torques that is the primary function of the 
rigid body AMS computer program. Thus, by prescribing the 
motion of one gimbal at a time and repeating this for all of 
the AMS joints, one can check out the accuracy of the computer 
program for all possible AMS motions. 


For motion involving external forces and torques, two check 
cases were used. The first involved specifying a gravity vector 
and assigning essentially infinite inertia properties to the 
sixth body. The joint angles were all fixed thereby resulting 
in a simple statics problem of the AMS fixed to the ground. It 
was then an easy matter to compute the joint forces and torques 
to compare with those predicted by the computer program. 

To check the accuracy of the program to predict the motion 
of the Shuttle caused by external forces and torques acting on 
both the AMS and the Shuttle, all six of the bodies were model- 
led as spheres of equal diameter and mass, acted upon by ex- 
ternal forces and torques. The joint angles were fixed at 
values such that the six spheres occupied a common center re- 
sulting in the problem of a single rigid body acted upon by 
external forces and torques. Because of the spherical symmetry 
it is a straight-forward matter to determine the body components 
of the angular velocity. Rather than appeal to the classical 
solution of the kinematical equations (the attitude angles) it 
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was easier to solve them by numerical integration and compare 
these results with those of the rigid body program. 

It is noted here that exact agreement between all of the 
check cases and the corresponding computer solutions was ob- 
tained, 

3, Inertia Properties 

In arriving at the inertia properties for the AMS, a sep- 
arate computer program was developed to optimize the AMS 
counterbalance design. This program and the corresponding 
analysis are described in detail in Chapter IV. The AMS model 
shown in Figure IV- 39 served as the basis for computing the 
inertia properties for use in the rigid body dynamics program. 
Once again, a computer program was developed for this purpose. 
The inputs to this program are the quantities defined in 
Figure IV-39 and the output consists of the masses, principal 
moments of inertia and the hinge vectors defined in Appendix 
A,. Using the design data contained in Chapter IV, the input 
data for the rigid body dynamics program are shown in Table 
VI- 1. Note that the data for the SAMS reflect the absence 
of the counterbalance and the presence of the Shuttle (bodies 
1 and 6, respectively). On the other hand, the AMS data 
includes the 2900 lb counterbalance and the steel connecting 
rods (see Chapter IV), The large values for the inertia pro- 
perties of body 6 in this case, are used to effectively fix 
the AMS to an inertial platform. In both cases, the data for 
body 5 represents a 15 ft diameter, 60 ft long, 65,000 lb 
cylindrical payload. 
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Table VI -1 


Inertia and Geometry Data for Rigid Body Dynamics Program 


2 

Mass M (Slugs) and Principal Moments of Inertia 1^, (Slug-Ft ) 


A 

1 

2 

3 

4 

5 

6 

M A 

**1 

*X2 

I A3 

0 

0 

0 

0 

13. 74 
4.01 
644. 
644. 

3. 33 
. 781 
127 
127 

1.55 

0.109 

1.22 

1.22 

2.02 x 10 3 
5.67 x 10 4 
6.35 x 10 5 
6.35 x 10 5 

4 

1 x 10* 

2.3 x 10 6 
1.51 x 10 7 
1.51 x 10 7 


Hinge Vector Components H (Ft) 

A J K- 


A j 

11 

21 

22 

23 

33 

34 

44 

45 

55 

62 


B 

0 

-4. 84 

-4. 84 

13.6 

-5.78 

12. 7 

-1.5 

1.5 

0 

-32.8 

K 

2 

0 

0 

0 

0 

0 

0 

0 

0 

0 

10.0 


3 

0 

0 

0 

0 

0 

0 

0 

0 

-7.50 

-17.8 


(a) SAMS DATA 


Mass M (Slugs) and Principal Moments of Inertia I . (Slug-Ft ) 

A j 


A 

1 

2 

3 

4 

5 

6 

M\ 

90.9 

29.6 

3.33 


2.02 x 10 3 

1 x 10 10 

B 

116 

6.73 

2.53 


5.67 x 10 4 

1 x 10 10 

116 

1.24 x 10 3 
3 

1.29 x 10 2 
2 


6.35 x 10 5 
5 

1 x 10 10 
10 

X A3 

28.7 

1.24 x 10 

1.29 x 10 


6.35 x 10 

1.x 10 1 


Hinge Vector Components H^.^ (Ft) 


Aj 

11 

21 

22 

23 

33 

34 

44 

45 

55 

62 


i 

.527 

-6.86 

-4.42 

14.1 

-5.78 

12. 7 

-1.50 

1.50 

0 

-32.8 

K 

2 

0 

0 

0 

0 

0 

0 

0 

0 

0 

10.0 


3 

0 

0 

0 

0 

0 

0 

0 

0 

-7.50 

-17.8 


(b) AMS DATA 
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4, Results of Rigid Body Dynamics Analysis 


In order to determine the dynamic torque requirements for 
the AMS it was decided to investigate several 90° deployment 
tasks of the 65,000 lb payload. These tasks are illustrated 
in Figure VI-1. 

The inertia properties of the payload and shuttle are those 
for bodies 5 and 6 in Table VI-1 (a). For simplicity, it was 
assumed that the payload and shuttle mass center are initially 
coincident, and the longitudinal axis of the payload is ini- 
tially parallel to the roll axis of the shuttle. The location 
of the shoulder joint relative to the shuttle mass center is 
given by in Table VI- 1(a). Finally, it is presumed that 
the wrist extension is perpendicular to the longitudinal axis 
of the payload and the attach point is directly above the 
payload mass center. 


Under the foregoing assumptions, the initial configuration 
of the AMS is defined by the following joint angles (see 
Appendix A for definition of joint angles): 


6 


21 


°23 °» °22 


•12. l c 




-32.8° 


°41 °» e 42 


-77.4°, 0 = 32.8° 




0, Q 52 = -90° 


All of the joint angles with the exception of the shoulder 
pitch angle (t^) are maintained at their initial values. The 
shoulder pitch angle is increased by 90° during the payload 
deployment. The net result is that the payload mass center 
moves on a circular arc in_the shuttle pitch plane. The time 
histories of 9 , G 22 an< * G 22 are P rescr ib e< ^ such that the 

tangential velocity of the payload mass center assumes the 
profile illustrated in Figure VI-1. In each case, the payload 
moves through the same 90° arc. What distinguishes one task 
from another is the task time, TT, during which the maneuver 
must take place; and the distance traveled while braking the 
payload to a stop. (It is assumed that the accelerations 
during the initial and final stages of motion are equal in 
magnitude and opposite in direction). Task times of 3, 5 
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and 7 min. were investigated, and for each of these, stopping 
distances of 1. 0, 1, 5, 2, 0, and 3. 75 ft were assumed. 

The payload and shoulder pitch motion for the 3 min. task 
time and the 2 ft stopping distance are shown in Figures VI- 2 
and VI- 3. The motion induced in the shuttle during this task 
is shown in Figure VI-4, It is noted that the shuttle pitches 
approximately 7° during the payload deployment. 

The task described above was repeated once with the shuttle 
assumed fixed in inertial space and again for the counterbalanced 
AMS attached to an inertial platform with the direction of 
gravity perpendicular to the pitch plane. The required pitch 
joint torques at the shoulder, elbow, and wrist for the first 
two cases are shown in Figure VI-5, The joint torques for the 
counterbalanced AMS are illustrated in Figure VI- 6. Comparison 
of the joint torques shows that the torques required to execute 
the task using the counterbalanced AMS is almost identical to 
those required when the SAMS is attached to an inertially fixed 
shuttle. However, both of these cases require approximately 
25% more torque over those required to execute the same task 
when the manipulator is attached to a free shuttle. The con- 
clusion to be drawn is that more torque will be required to 
execute a task on the ground (using the counterbalanced AMS) 
than will be required to execute the same task in space (using 
the SAMS attached to a free shuttle). The amount of extra 
torque required will be directly proportional to the mass of 
the payload for a particular task. 

The torques required during all of the tasks (using the 
counterbalanced AMS) are summarized in Figure VI- 7, where they 
are plotted as functions of stopping distance (i.e. , the dis- 
tance traversed by the payload during the braking phase of the 
maneuver). Also shown in these graphs are the static torque 
requirements defined as those required to exert a 30 lb static 
tip force (tangential direction) when the AMS is fully extended. 
Comparison of the three curves shows that the wrist joints 
require the greatest increase in torque over the static 
requirement. This effect diminishes in the direction of the 
shoulder joint. 

Finally, using the 5 min. deployment time and the 2 ft 
stopping distance as defining the dynamic torque requirement, 
the static torque requirements and dynamic torque requirements 
are shown in Figure VI-8 along with the joint torques selected 
to meet both of these requirements. 
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Figure VI-2 Payload Velocity and Shoulder Pitch Acceleration 
for 3 Min, Task Time and 2 ft Stopping Distance 






Figure VI- 3 Shoulder Pitch Rate and Angle for 3 Min. 

Task Time and 2 ft Stopping Distance 
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Figure VI-4 Shuttle Pitch Rate and Angle 





Shoulder (878) 
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Figure VI-5 SAMS Joint Torques 
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Figure VI- 6 AMS Joint Torques 
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Figure VI- 7 Joint Torques vs Stopping Distance 


STATIC TORQUE REQUIREMENT 


DYNAMIC TORQUE 
REQUIREMENT 


Arm Fully Extended - 30 Lb Tip 5 Min. Deployment Time 

Force 2-Ft Stopping Distance 



SELECTION 


Shoulder 1200 Ft-Lbs 

Elbow 650 Ft-Lbs 

Wrist 300 Ft-Lbs 


Figure VI- 8 Joint Torque Selection 
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B. VIBRATION ANALYSIS 

The reasons for conducting a vibration analysis of the AMS 
are twofold. First, one concerned with designing a control 
system for the AMS (including active damping techniques), would 
benefit from the knowledge of mode shapes and frequencies of 
the AMS as it vibrates about an equilibrium position; and second, 
such a study provides the elastic behavior of the major AMS 
segments for use in the nonlinear dynamic response program 
(see Section C ). 

The first of these objectives is achieved by analyzing the 
AMS as a single structure including the elastic constraints at 
the joints. In what follows, this type of analysis will be 
called a coupled vibration analysis. The second goal is rea- 
lized by examining the major components of the AMS separately 
without regard to the flexibility at the joints. This type of 
analysis will be referred to as an uncoupled vibration analysis. 

In the early stages of this contract a coupled vibration 
analysis was conducted of an AMS design concept involving a 
flexible Elgiloy tape as the means by which torque is trans- 
mitted from the elbow motor to the counterbalance mass. Later, 
an uncoupled vibration analysis was performed with the Elgiloy 
tape being replaced by pivoted steel rods. Both of these in- 
vestigations are presented in what follows. 

1. Coupled Vibration Analysis of AMS with Elgiloy Tape 

a. Mathematical Model and Physical Constants - Elements 
of the mathematical model are shown schematically in Figure 
VI- 9 for the counterbalanced AMS. The AMS is shown with the 
arm extended aft and parallel to the orbiter longitudinal axis. 
Each element has bending, torsional, and axial compliance in 
addition to distributed mass and inertial properties. Node 
points have six degree of freedom and the geometry is defined 
precisely in Table VI-2. The model of the space version is 
a simple counterbalanced model without Nodes G, H, I, and J. 
Elements G-I and J-D are rigid elements representing pulleys 
of the counterbalanced system and element I-J represents the 
Elgiloy tape. The pulley at Node D is integral to that joint; 
whereas, the pulley at Node G is connected to the second 
counterbalance arm only. Bending moment about the Y axis 
cannot be transmitted between elements C-G and G-H, The tape 
is allowed to experience both tension and compression to take 
advantage of counterbalance symmetry. 
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Figure VI-9 Mathematical Model of Structural Elements 


Table VI- 2 Degree of Freedom Table 


Node 

Degree of Freedom 

Node Location 

(in.) 

Ident 

X 

Y 

Z 

TX 

TY 

TZ 

X 

Y 

Z 

A 

56 

57 

58 

59 

60 

61 

0 . 

60.0000 

0 . 

B 

25 

26 

27 

28 

29 

30 

0 . 

60.0000 

128.0000 

c 

19 

20 

21 

22 

23 

24 

0 . 

0 . 

128.0000 

D 

13 

D 

15 

16 


18 

162.0000 

0 . 

128.0000 

E 

7 

H 

9 

10 


12 

360.0000 

0 . 

128.0000 

F 

1 

H 

3 

4 

5 

6 

450.0000 

0 . 

128.0000 

G 

37 

38 

39 


41 

42 

-27.7200 

0 . 

128.0000 

H 

31 

32 

33 


35 

36 

-39.9600 

0 . 

128.000 

I 

43 

44 

45 


47 

48 

-27.7200 

0 . 

132.0000 

J 

49 

50 

51 


53 

54 

162.0000 

0 . 

132.0000 


ft 

Table VI-3 Beam Stiffness Data (Stiffness Parameter x 10 ) 


Member 

El 

X 

(lb-in. 2 ) 

El 

y „ 

(lb-in. 2 ) 

El 

z 

(lb-in. 2 ) 

GJ 

(lb-in. 2 ) 

AE 

(lb) 

A-B 

100000.0 

100000.0 

— - 

100000.0 

100000.0 

B-C 

100000.0 


100000.0 

100000.0 

100000.0 

C-D 



1239.1 

1239.1 

926.4 

139.74 

D-E 

— 

470.8 

470.8 

352.0 

52.75 

E-F 

— 

100000.0 

100000.0 

100000.0 

100000.0 

C-G 

—— . 

1239.1 

1239.1 

926.4 

139.74 

G-H 

— 

1239.1 

1239.1 

926.4 

139.74 

G-l 

100000.0 

100000.0 


100000.0 

lOul''0.0 

D-I 

100000.0 

100000.0 

— 

100000.0 

100000.0 

I-J 


1.0 

1.0 

.. .. i 

1.0 

1.5557 
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Stiffness parameters, based on preliminary design data, for 
each component beam are given in Table VI- 3, Because the 
members supporting the counterbalance weights are undefined, 
their stiffnesses were assumed identical to those for the 
upper arm. Stiffnesses of the deployment/support mechanism, 
pulley elements, and payload attachment element were assumed 
rigid relative to the rest of the structure. Bending and 
torsional stiffness of the tape is negligible. The Elgiloy 
tape was assumed to be 2 in. wide and to be in tension over 
a 237. 6 in. length (96 in. single layer over the pulleys and 
a 141.6 in. triple layer between the pulleys). Tape stiffness 
(K) is, then, 8200 lb/ in. for an elastic modulus of 29.5 x 
10 6 psi. As defined in the model, the tape is only 189. 72 in. 
long; therefore, the equivalent AE value is equal to that 
length times the stiffness. Because joint drives and gear 
trains are not defined for this configuration, they are assum- 
ed to be similar to, but stiffer than, those defined in 
Reference 1. That study recommended harmonic drives (USM* 

#4M at the shoulder and elbow and USM #2M for the wrist joints). 
Stiffness of the joints is assumed to be four times the stiff- 
ness specified for harmonic drive assemblies in Reference 3. 

The stiffness values are: 3. 36 x 10° in. -lb/rad for the 

shoulder and elbow joints and 1.88 x 10° in. -lb/rad for the 
wrist joints. For ease in modeling, compliances for the three 
shoulder joint mechanisms were all assumed to be located in the 
upper arm, 2-1/2 in. outboard of the deployment boom centerline. 
The orientation of the arm was assumed such that the elbow drive 
acts in pitch. Wrist mechanisms are: Pitch at X Sta 162, yaw 

at X Sta 180, and roll at X Sta 185.5. 


Mass and inertia data are defined in Tables VI-4 and VI-5, 
Distributed inertias were based on upper arm and forearm 
outside diameters of 12 in. and wall thickness of 0.1785 
and 0.0827 in., respectively. Distributed mass was chosen 
arbitrarily for the deployment boom/support and was considered 
negligible for the counterbalance mechanism. The outboard counter- 
balance weight was chosen so that its moments about Node G bal- 
anced the forearm and wrist gravity moment about Node D. The 
other counterbalance weight was chosen so that it and the out- 
board counterbalance weight would balance the gravity moment of 


* United Shoe Machinery Corporation. 



Table V3t-»4 Distfibutad Mass 
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the total arm. The payload inertias were defined to orient the 
payload with its longitudinal axis parallel to the Z axis. The 
inertias were based on a homogeneous circular cylinder (15 x 
50 ft). 

b. Analysis - The analysis consisted of developing the 
homogeneous equations of motion and solving them for the mode 
shape vectors and modal frequencies. The solutions were ob- 
tained with the use of the Martin Marietta computer program 
VIB3. VIB3 was also used to form the mass and stiffness matri- 
ces. 


Solutions were obtained for both the counterbalanced (CB) 
and the space version of the AMS in four configurations (a 
total of eight solutions). The eight cases are depicted below 
and consist of both loaded and unloaded configurations, each 
with the arm fully extended along the X axis and with the 
elbow rotated 90° up. 


Unloaded 

Loaded 

90° Elbow 

Extended 

90° Elbow 

Extended 

Space 

CB 

Space 

CB 

Space 

CB 

Space 

CB 

i 

1 



ep 

T 

41 


JT 

U 


°x 


U 

l u 



c. Results - Results from this study include: mass matrices, 

stiffness matrices, flexibility matrices, generalized mass 
matrices, mode shapes, and frequencies. These data are stored 

in detail on magnetic tape and presented in summary form in 
this report. The first TO natural frequencies are presented 
in Table Vl-6 and some selected mode shapes are depicted in 
Figures VI-10 and VI-11. 

d. Discus si on - By comparing the frequencies shown in 
Table VI-6, one can conclude that the dynamical behavior of 
the AMS is sensitive (to some extent) to payload mass, geo- 
metrical configuration, and counterbalance mechanism. It can 
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Table VX-6 Modal Frequencies (cps) 


Loaded Configurations 

q 

< 

rl 

0.03083 

0.05972 

0.07882 

0.26962 

2.5666 

3.0450 

4.8471 

8.5198 

10.171 

17.628 

q 

p 

4 

0.02226 

0.03073 

0.09633 

0.26944 

3.0653 

4.8039 

8.5331 

10.169 

57.640 

64.220 


i 

0.03055 

0.04273 

0.10641 

0.18324 

0.26980 

2.5960 

3.5001 

12.061 

17.612 

18.825 


1 

0.02474 

0.04267 

0.10737 

0.18337 

0.26937 

3.4992 

12.063 

47.766 

55.786 

59.750 

Unloaded Configurations 

l 

I 

0.90033 

0.96424 

2.5909 

4.8915 

9.5074 

17.514 

18.389 

22.154 

24.226 

29.586 


4 

0.90515 
0.96098 
4.8596 
9.5199 
22 . 141 

. 

24.224 

41.482 

63.298 

75.669 

88.593 

i 

R 

1863 

3947 

5471 

9217 

8135 

610 

702 

656 

738 

064 

ai 

1 . 

1 . 

2. 

2. 

3. 

17. 

18. 
20. 
22. 
30. 


4 

1.1863 

1.3909 

2.8371 

3.8119 

20.657 

22.440 

49.930 

63.828 

77.372 

83.654 

Mode 

Number 

iHcsirO^finvp r^oOCTNO 

i — i 
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3rd Mode-Counterbalanced 



2nd Mode-Space Version _ 

2nd Mode-Counterbalanced 

(b) Top View 

Figure VI- 11 Normalized Mode Shapes, AMS Unloaded and Extended 



also be seen that payload mass is the most significant parameter 
and geometry configuration the least. It should be noted, how- 
ever, that a large payload (60,000 lb) was used in the 
loaded cases; and, therefore, for the smaller payloads, one 
could expect a smaller change in frequencies between the loaded 
and unloaded cases. The foregoing observations apply to both 
the space and counterbalanced versions of the AMS. 

By comparing the frequencies in Table VI- 6 for the AMS in 
the extended, unloaded configuration, it can be seen that the 
first two frequencies are the same, but a new modal frequency 
(lying between the second and third frequencies of the space 
version) is introduced by the addition of the counterbalance 
mechanism. Further, inspection of the last two columns of 
Table VI-6 reveals that the behavior of the loaded, extended 
configuration of the AMS is more severely affected by the add- 
ition of the counterbalance mechanism; in that, the fundamental 
mode of the space version is eliminated. 

The similarities and differences in behavior of the space 
and counterbalanced versions of the AMS are further illustrated 
by the mode shapes depicted in Figures VI- 10 and VI-11. Figure 
VI-11 illustrates that, for those frequencies retained by the 
counterbalanced system, the mode shapes of the space and coun- 
terbalanced versions in the unloaded, extended configuration 
are very nearly identical. From Figure VI- 10 it can be seen 
that, in the loaded extended configuration, the second mode 
of the space version is identical to the first mode of the 
counterbalanced AMS, the motion taking place in the horizontal 
or X-Y plane. Figure VI-10 also shows the first mode of the 
loaded extended configuration of the space version of the AMS 
(i.e., that mode which is eliminated by the addition of the 
c ount erb al ance ) . 

Since the vibration analysis presented above was conducted, 
the Elgiloy tape has been replaced by steel connecting rods, 
the counterbalance mechanism has become better defined, and 
stiffness data has been obtained for the gear trains. In light 
of these developments, the coupled vibration analysis should 
be updated to reflect such design changes. 

While conducting the uncoupled vibration analysis (pre- 
sented in the next section), it became apparent that a major 
contributor to the differences in vibrations between the SAMS 
and the AMS was the constraint conditions assumed at the 
shoulder. For this reason, when the vibration analyses are 
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updated, greater emphasis should be placed on computing the 
stiffness of the support structure. 

2. Uncoupled Vibration Analysis of AMS with Steel Rods 

As mentioned earlier, the uncoupled vibration study deals 
with the major components of the AMS as individual structures. 
The necessary constraints (including the flexible joints) to 
properly connect these components are provided in the flexible 
body dynamics program (see Section D). The results of this 
analysis provide a mathematical description of the elastic 
behavior of the corresponding AMS components modelled in the 
dynamics program. 


The uncoupled structural models are shown in Figure VI-12. 
The 18.5 ft lower arm is an aluminum tube with a 12 inch dia- 
meter and a .08 inch wall thickness; it is assumed to be can- 
tilevered at the elbow. The tip of the lower arm is loaded 
with the mass and reflected inertia of the 3 ft wrist connected 
to the 65,000 lb payload. The length and diameter of the 
upper arm is identical to those of the lower arm; the wall 
thickness is 0. 18 inch in this case. The mass and inertia of 
the steel connecting rods between the elbow and counterbalanced 
elbow are included in the model. It was decided that these 
rods do not contribute to the bending stiffness of the upper 
arm. The upper arm is assumed cantilevered at the shoulder 
and is loaded at the elbow joint with the mass and reflected 
inertia of the payload, wrist, and lower arm. Finally, the 
counterbalanced upper arm (to the left of the shoulder) is 
simply a 29,25 in extension of the upper arm (including steel 
rods) and is loaded with the mass and reflected inertia of 
the 2900 lb counterbalance weight. Finally, to monitor the 
elastic deformations, both the upper and lower arms were 
assigned 5 reference points as shown in Figure VI- 12. 

The first three frequencies and modes for the upper and 
lower arms are shown in Figures VI- 13 and VI- 14, respectively. 
It is noted that the frequencies corresponding to the higher 
modes are more than two orders of magnitude greater than these. 
It can be seen in Figure VI- 13 that the counterbalance upper 
arm does not participate in these low frequency modes. This 
is due to the six degree of freedom constraint at the shoulder. 
Thus, for the structural model assumed in this case, the 
counterbalanced and noncounterbalanced versions of the "mani- 
pulator will exhibit the same vibrational characteristics. 
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Figure VI-12 Uncoupled Vibrational Analysis Structural Model 



Mode Description Freq (Hz) 

1 Pitch 0. 055 
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Figure VI- 13 Frequencies and Modes of Upper 




The next section deals with a comparison of rigid and flex- 
ible body behavior of the counterbalanced AMS during a payload 
handling task. The uncoupled vibration data presented above 
was incorporated in the dynamics program to provide the elastic 
effects. 
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C, NONLINEAR FLEXIBLE BODY ANALYSIS* 


Dynamic response analyses of the AMS is currently being per 
formed through application of a generalized n-body digital com- 
puter program developed by the Martin Marietta Corporation* 

The underlying assumption of this program is that any physical 
system can be realistically modelled as an assemblage of n- 
inter connected bodies, some or all of these being flexible, 

1. Mathematical Model and Computer Program 

a. Equations of Motion - The equations of motion for an 
individual body are developed thru application of Lagrange 
equations with constraints. The resulting nonlinear, first 
order differential equations include elastic characteristics 
via normal vibration modes. These modes are provided by the 
uncoupled vibration analysis described in section C, 

Coupling between two or more bodies is accounted for by 
using Lagrange multipliers to describe the kinematic con- 
straint conditions. This formulation allows individual bodies 
to undergo large excursions relative to the other bodies. The 
n-body system is not restricted to the form of a topological 
tree; some similar analytical techniques which have appeared 
in the literature do have this restriction. 

b. State Equations - The first order, nonlinear equations 
of motion define a state space. The state variables, for each 
of the n-bodies are: 

1) Generalized momenta corresponding to 3 translations 
3 rotations, and M elastic modes. 

2) Elastic normal coordinates for each of the M modes. 

3) Inertial position and attitude by means of 3 posi- 
tion coordinates and 4 Euler quaternion elements (Euler para- 
meters are used to eliminate possible singularities that may 
occur when considering large relative excursions). 

Additional state variables include: 

1) Relative position coordinates describing the atti- 
tude of any body with respect to any other. 

2) Control system variables as defined by the user’s 

special control laws. 

*The work presented in this Section was performed under In- 
dependent Research and Development Task No. D-05R entitled 
"Teleoperator Manned Control and Mission Simulation". 
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c. Numerical Integration - Currently, numerical integra- 
tion of the state variable time derivatives is accomplished 
thru implementation of the 4th order Runge-Kutta algorithm 
with a fixed time step. The possibility of implementing a 
predictor - corrector algorithm will be investigated in an 
effort to reduce computation time. 

d. Users* Options - The digital computer program has been 
designed to be as versatile as possible and therefore several 
options are available to the user; 

1) Prescribed External Force/Torque Field - A. pre- 
scribed time dependent, external force/torque field can be 
applied to any of the n-bodies in the system. 

2) Initial Positions/Rates - An individual body may 
be assigned initial conditions describing position and/or rate. 

3) Relative Motion - The relative motion between any 
two bodies can either be prescribed by the user as a time 
dependent function or can be controlled by an appropriate 
control law, A universal interface has been included in this 
program to allow the user to specify control logic applicable 
to his particular problem, 

e. Applications - The versatility of the generalized com- 
puter program has been demonstrated thru application to 
several problems: 

1) A hypothetical dual spin space station consisting 
of a stator (hub) and two counterrotating appendages was 
modelled. The bodies were assumed rigid with prescribed 
initial rates. 

2) The Sky lab T02 7 boom, y oke camera experiment 
package was investigated. The boom was considered elastic; 

the yoke and camera were rigid. Both prescribed and controlled 
motions were investigated. Comparison of analytical and test 
results was excellent. 

3) The 6-body rigid AMS model described in section B 
was modelled with relative motion at the joints being prescribed. 
Exact agreement of the results from the two programs was ob- 
tained. 
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2. Comparison of Rigid and Flexible AMS Behavior 

The flexible body dynamics program described above was 
used to obtain a comparison between the rigid and flexible 
behavior of the counterbalanced AMS for the same payload 
handling task. The task considered is depicted in Figure 
VI-15 and involves the 65,000 lb payload with its longitudi- 
nal axis perpendicular to the manipulator arms. The AMS is 
initially fully extended along the x-axis, and the shoulder 
and elbow yaw angles are prescribed identical counterclockwise 
rotation, } 9, as shown. The resulting motions of the AMS and 
payload occur entirely in the yaw plane. The time history 
of P is also shown in Figure VI-15 and reflects a 20 sec 
acceleration, a 60 sec coast phase, and a 20 sec braking 
period. The acceleration and braking magnitude of 1. 31 x 
10~4 rad/sec^ is equivalent to a 20 lb tangential tip force 
when the arm is fully extended. 


Because the motion takes place in the yaw plane, only the 
fundamental yaw modes shown in Figures VI-13 and VI-14 were 
used to provide the flexible body effects. To keep matters 
simple, ideal (rigid) joints were assumed for the wrist, 
elbow, and shoulder. Finally, because the elbow and shoulder 
joint angles are prescribed as functions of time, the task 
can be thought of as involving an ideal control system (i.e. , 
one that involves no delays between commands and response). 

The trajectory of the payload mass center resulting from 
the joint angle prescription is shown in Figure VI- 16. The 
payload follows the same trajectory in both the rigid and 
flexible cases. This means that, for the flexible case, the 
oscillations take place along the trajectory. The differences 
between the rigid and flexible motions are more apparent in 
Figures VI- 17 and VI-18, 

Looking first at the X motion, there is no perceptible 
difference between the rigid and flexible case until the joint 
motion has stopped (at T = 100 sec). Beyond 100 sec, the X 
position of the payload mass center for the flexible AMS 
oscillates about that of the rigid case (not shown beyond 100 
sec). As shown in Figure VI-17, these oscillations are approx- 
imately 0.6 in peak-to-peak with a frequency of 0.05 Hz 
(20 sec period). 

Because the motion of the payload is predominantly in the 
Y direction, one could expect greater differences in this 
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Figure VI-16 Payload Trajectory for Rigid and Flexible AMS 
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Figure VI- 17 Payload X Position vs Time 


VI-36 



coordinate when comparing results for the rigid and flexible 
cases. This is born out in Figure VI-18 where it is seen 
that the Y position in the flexible case lags by as much 
as 2. 7 in behind that of the rigid cas'e during the accelera- 
tion phase (first 20 sec). It appears that, between 20 and 
100 sec, the Y position for the flexible and rigid case are 
identical. There is reason to believe however, that small 
oscillations do occur (in the flexible case) during this phase 
of the task; they are simply too small to be visible in 
Figure VI- 18. As with the X position, it is seen that Y 
coordinate (flexible case) oscillates about that of the rigid 
case after 100 sec. In this case, the amplitude is approxi- 
mately 3 in (peak-to-peak) with a 0.05 Hz frequency. Although 
not apparent from the X and Y curves, there is a small amount 
of damping present resulting from an assumed 1% structural 
damping in the computer program, 


The shoulder, elbow, and wrist, joint torques required for 
the task are shown in Figures VI-19, VI-20, and VI-21, 
respectively. In each case, the flexible body torque is 
initially less than the corresponding rigid body torque. 

After about 5 sec however, the flexible torque requirement 
exceeds its rigid counterpart, peaking at approximately twice 
the latter after 10 sec. During the remainder of the accel- 
eration phase the flexible requirement decreases to a zero 
value about which it oscillates until the braking phase begins. 
The braking period follows the same pattern as the accelera- 
tion phase. It is the torque oscillations during the coasting 
period (20-80 sec) that indicate similar oscillations in pay- 
load position during this time (it is recalled that such 
oscillations were not visible in the curves showing X and Y 
vs time). 

One should not interpret the foregoing results to mean 
that a flexible manipulator requires approximately twice the 
torque capability of a rigid AMS. This is true if one desires 
identical joint motions in both cases. However, if one is 
willing to accept flexible AMS payload trajectories involving 
oscillations about the rigid body trajectory, then the rigid 
body torque capabilities will suffice. 
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Figure VI- 18 Payload Y Position vs Time 
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Figure VI-19 Rigid and Flexible AMS Shoulder Torque Requirement 
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Figure VI-20 
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T (Sec) 

Figure VI- 21 Rigid and Flexible AMS Wrist Torque Requirement 


D. SUMMARY AND RECOMMENDATIONS 
1. Rigid Body Analysis 

The rigid body dynamics model and corresponding computer 
program have been derived and validated by means of several 
check cases. Supplementary to the dynamics program, there is 
an additional computer program which accepts AMS design data 
(e,g, tube diameter, joint weight, etc.) and computes the 
necessary inertia properties for use in the dynamics model. 

Together, these programs have been used (by specifying 
several payload handling tasks) to arrive at joint torque 
requirements of 1200, 650, and 300 ft-lbs for the shoulder, 
elbow, and wrist joints, respectively. In the process, it was 
shown that, for identical tasks, the AMS will require more 
torque than the SAMS; this is due to the fact that the AMS 
is attached to an inertial platform while the SAMS is attached 
to the shuttle. This effect will become less noticeable for 
payloads smaller than the maximum (65,000 lbs). It was also 
shown (for the maximum payload), that the added inertia of 
the counterbalance mechanism is sufficiently small as to 
result in no significant additional torque requirement over 
the non- counterbalanced manipulator. However, this may not 
be the case for smaller payloads. Finally, it was found that 
a 90° deployment of the 65,000 lb payload will result in a 7° 
counterrotation of the shuttle; for smaller payloads, the 
shuttle rotation will likewise be smaller. 

For future work, it is recommended that the rigid body 
analysis be used primarily to measure the fidelity of 1-g 
simulations with the AMS, This would include a study of the 
interaction between the manipulator and the shuttle attitude 
control system for various size payloads. If such interactions 
are found to be significant, an investigation would be conducted 
to arrive at the means to include such effects in the 1-g 
simulations. Along the same line, the influence of orbital 
effects (e,g, , gravity gradient torques) should be investigated 
and a determination made as to the inclusion of these effects 
in the 1-g simulations. Regarding the simulation facility 
itself, a systematic study should be conducted to determine 
for what range of payloads is the added inertia of the counter- 
balance significant and for what payloads is fixing the AMS 
to an inertial platform a serious consideration. Finally, the 
impact of typical simulation facility error forces (e.g. slanted 
floor, airpad drag, etc.) on AMS performance should be investi- 
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gated in order to define the tolerances for the simulation fac- 
ility. 

2. Vibration Analysis 

A vibration analysis of an earlier version of the AMS (30 
ft manipulator, 60,000 lb payload) resulted in fundamental 
frequencies on the order of 1 Hz for the unloaded AMS (both 
counterbalanced and space version) and fundamental frequencies 
of . 02 - . 03 Hz for the loaded (60, 000 lb payload) manipulator. 

As could be expected, the vibrational behavior of both the 
counterbalanced and non- counterbalanced versions of the AMS is 
sensitive to payload mass and arm configuration. Significant 
differences and similarities were found to exist between the 
vibration behavior of counterbalanced and non- counterbalanced 
AMS. It is felt that the differences in behavior are due, 
in large part, to the constraint conditions at the shoulder. 


It is recommended that the vibration analysis be updated 
to include the latest design changes with careful attention 
given to the shoulder joint and the support structure. 

3. Nonlinear Flexible Body Analysis 

The generalized flexible body dynamics program was used to 
compare rigid and flexible AMS behavior for a planar payload 
handling task. The motion of the 65,000 lb payload was obtained 
by prescribing identical time histories for the shoulder and 
elbow yaw joints. The results for the flexible AMS revealed 
oscillations (about the rigid body trajectory) with approximately 
a 3 in amplitude (peak- to- peak) and a frequency of 0. 05 Hz, . 


It is recommended that the flexible body dynamics program 
be updated along with the vibration analysis and, in the pro- 
cess, joint flexibility should be included. This program should 
be used primarily to verify the control system design and any 
active damping techniques that are developed. The program is 
also well suited to establish the validity of any simplified 
dynamics program that might be used for man- in- the -loop simu- 
lations. 
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APPENDIX A . Derivation of the Rigid Body Equations of Motion 


A, INTRODUCTION 

This appendix presents a detailed derivation of the equations 
of motion of six interconnected rigid bodies. A detailed descrip- 
tion of the generalized (AMS) model along with some remarks as to 
how this model is reduced to the space and 1-G versions of the AMS 
are presented in Section B. The vector form of the equations of 
motion are developed in Section C, and scalar form of these equa- 
tions are derived in Section D. 

B. SYSTEM DESCRIPTION 

The generalized AMS model consists of six rigid bodies inter- 
connected by five hinges as shown in Fig. A-l. It is assumed that 
the motion takes place in the presence of an arbitrary gravitational 
acceleration denoted by the vector g. Each body is presumed to 
have arbitrary inertia properties and hinge locations. Finally, 
although not shown in Fig. A-l, each body is acted upon by arbi- 
trary, external, non-gravitational forces and torques. 


With the generalized model just described, it is a simple 
matter to extract both the 1-G and space versions of the AMS. 

First, to obtain the space version (without orbital effects in- 
cluded) one merely has to choose zero inertia properties for 
body 1, assign the Shuttle inertia properties to body 6, and select 
zero magnitude for the gravitational vector g. On the other hand, 
to extract the 1-G, g is assumed to be parallel to the vertical, 
and body 6 is assumed fixed in the inertial reference frame. 

C. VECTOR EQUATIONS OF MOTION 

Newton’s second law, for each of the bodies shown in Fig. A-l, 
can be written; 
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Figure A-l Generalized AMS Model 
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where F (X = 1,2, . , , , 6) is the resultant force, exclusive of 

A 

hinge interaction forces, acting on body X; , is the hinge inter- 

action force on body X at hinge j; and m is the mass of body X. 

A 

Euler’s dynamical equations for the six bodies are; 
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I- • CO- + W_ X I_ * = 

5 5 5 5 5 


*6 ‘ "6 + "6 x *6 ' “6 ’ 


*5 + *55 + *55 x *^5 


*6 + *62 + S 62 x *62 


(A-ll) 

(A-12) 
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where I (A = 1,2,_. , ,, 6) is the inertia dyadic of body A for 
its mass center; is the angular velocity of body A in inertial 

space; T is the resultant torque exclusive of hinge interaction 

torques acting on body A; and . is the hinge interaction torque 

A J 

on body A at joint j. 


From Fig. A-l it can be seen that knowledge of the attitude 
of each of the six bodies is sufficient to determine the configura- 
tion and attitude of the system. For this reason, it must be 
possible to combine Eqs, (A-l) - (A-12) to obtain six equations for 
the rotational motion which are uncoupled from the translational 
equations. A detailed description of this reduction in the equa- 
tions of motion is given by Hooker and Mar.gul.ies for the general 
n-body problem in reference 1. The development presented by 
Hooker and Marguli.es is fairly involved even when applied to six 
bodies. For this reason, only the results in reference 1 per- 
tinent to the problem at hand will be presented here. 


The following definitions prove useful in the sequel: 


= £ ■» 
VES xj 


■ s yK.i h xj 


°Aj D A + H Aj 


=* 

X A 






K D A D A + y^ m Aj 5 Aj D Aj] 

j£ J A 


(A-13) 


(A-14) 


(A- 15) 
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where . denotes the set of (labels of) bodies connected to 
Aj 

body A at joint j, J is the set of labels for hinges in body A, 
_ A 

and I is the identity dyadic. The physical significance of the 
quantities defined above is best described in terms of Fig. k-2 


Mass Center 



Figure A-2 Augmented Body 2 


First, the mass distribution of each body is augmented by 

point masses at each hinge of the body (as shown for body 2 in 

Fig. A-2) , The amount of mass concentrated at hinge j of body A 

is called M and is equal to the sum of the masses of all those 
Aj 


bodies (excluding body A) connected to hinge j , either directly or 
indirectly. The mass distribution of the body in question along 
with the point masses at the hinges define a new mass center 
which is called the "barrycenter" (see Fig, A-2) . Now the vector , 

D , appearing in Eqs, (A- 14) and (A-15) denotes the position 

A 


vector of thejnass center of body A relative to the barrycenter of 
body A. The D . vector represents the position vector of hinge 
A J =* 

j of body A from the barrycenter of body A. Finally, 1^ denotes 

the inertia dyadic of the augmented body A about its barrycenter. 



The first step in obtaining the desired set of rotational 
equations is to solve Eqs. (A-l) - (A-6) for the hinge interaction 

forces F . . The result can be expressed in terms of the mass 

center acceleration of body p, p and the system mass center ac- 

»• u 

celeration, p, as follows 



(A-17) 


6 


where M = 



is the total mass of the system anf 


A=1 

is the total external force acting, on the system. Now 
shown in reference 1 that 


■\=1 


it is 





vK (p) 

\) 


(A-18) 


where K^(y) is that joint of body v which leads to body y. Now, 
since 


5 x ' "x x 5 x + "x x <“x x E x ) 


(A-19) 


>Xj " “X X ®Xj + “X x ( "X X D Xj> 


(A-20) 


it is possible, by means of (A-17) - (A-20), to obtain an expres- 

sion for each of the F~ in terms of the rotational motion. When 

*3 

these expressions are substituted into Eqs (A-7) - (A~12) ? there 
results (after considerable simplification); 



mm mm Tim Tih 


' • “l + Z 1 x h ' “l - f l + *U + S 1 * h + 5 11 X (f 2 + ™21 


+ f 3 + md 33 + F 4 + md 44 + f 5 + md 55 + f 6 + md 62 ) 


! • “2 + V V "2 ‘ T 2 + 4 * ? 22 + T 23 + °2 * F 2 + D 21 

x (f 3 + MD n ) + 5 23 X (F 3 + MD 33 + F 4 + MD 44 + Fj + MDjj) 


+ 5 22 x cf 6 + md 62 > 


‘ • »j t ij i I* ■ ij ■ ij t t"j t t“ 4 + 5 3 x F 3 + D 33 x CFj + MD n 
+ ? 2 + ™23 + ? 6 + “ 62 ) + °34 x (5 4 + “44 + f 5 + '® 35 ) ° 


4 ' »4 + »4 * h ■ “4 - *4 + *44 + J 45 + 5 4 x *4 + 5 44 x (i l + “ll 
+ f 2 + md 23 + f 3 + md 34 + f 6 + md 62 ) + d 45 x (f 5 + md 55 ) 


5 ' “5 + “5 x ! 5 ’ “5 ' ? 5 + *55 + 5 5 x f 5 + ®55 x [f l + f 2 + f 3 


+ f 4 + f 6 + m (5 U + d 23 + d 62 + d 34 + d 45 )1 



=* 


I 


6 


“6 + “6 * X 6 


+ h + *5 


“6 ’ 5 6 + J 62 + 5 6 x f 6 + 5 62 x [5 1 + h + *3 

+ M ®11 + S 22 + S 33 + =44 + S 55 >] 


(A-26) 


which are the desired set of uncoupled rotational equations. 

Now, for purposes of this study, it is assumed that the motion 
of bodies 1-5 relative to body 6 is specified, and it remains to 
determine the resulting motion induced in body 6 along with the 
— H — H 

forces, F 3 ., and torques, T , of interaction occurring at the 
Aj Aj 

joints. To facilitate this determination, the following quanti- 
ties are defined: 


M X M S D XK <y) X 5 yK (X) » (X " 1,2 ». ’ * ” 6) 

y^x A v 


h - T x + D x x h + 


E 5 


y^x 


XK x (y) X V (X " 1,2> ’ * ” 6) 


— ^ _ 

x • a), (X ■ 1,2, . . ., 6) 


Eqs. (A-21) - (A-22) can be rewritten in terms of the above 
quantities as: 

—IT _ 

T = N - L - M 
ii i i i 


— H _ _ _ 

T =s N - L - M 
i 55 5 5 5 


T?. = N, - L. - M, + T® 
44 4 4 4 55 


S 33 ' S 3 - L 3 - Mj + i“ 4 


(A-27) 

(A-28) 

(A-29) 

(A-30) 

(A-31) 

(A-32) 

(A-33) 
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(A-34) 


*22 ' S 2 - L 2 - fi 2 + T« 2 + 


S 6 - H - S 6 + *22 • 0 


(A-35) 


where advantage has been taken of the fact that the torques on 
either side of a joint are equal in magnitude and opposite in 
— H -h 

direction (e.g. , . Equation (A-35) is the differential 

equation for which must be integrated before the torques in 

Eqs. (A-31) - (A-34) can be evaluated; the reason being that_£he 

right hand sides of the torque equations are dependent upon u) e 

• 

and ca r . 

6 


^6 


The proper kinematic a 1 equations must be added to Eqs* (A-3Q) - 
(A-35) to complete the description of the rotational motion; these 
equations are given in the next section where the various vector 
quantities are put in component form* 


D, KINEMATICS AND SCALAR FORM OF THE EQUATIONS OF MOTION 


. 1, Reference Frames and Transformation Equations 


In order to assign values to the vector quantities appearing 
in Equations (A-30) - (A-35) , reference frames are defined by 

fixing mutually perpendicular unit vectors e^ „ (j = 1,2,3) in 

A 3 

body A as shown in Figure A-3, An inertial reference frame, 

R, is defined by the e (j ~ 1,2,3) unit vectors. It is assumed 

Kj 


that the e^ unit vectors are parallel to the principal axes of 
body A for its mass center. 


Now it is possible to express the relationships between the 
various reference frames by means of the following transformation 
equations*: 




R, 1,2, • • 



(A-36) 


^Unless otherwise specified, {} represents a 3 x 1 column matrix 
and [] indicates a 3 x 3 square matrix. 
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Figure A- 3 Reference Frames 

The elements of ^E^ 1 are determined by the means one chooses 
to describe orientations, In this case, Euler angles are used 
because they are easily related to gimbal angles which are as- 
sumed to exist at the joints of the AMS. It remains to specify 
the gimbal order present at each of the joints. To this end, 
the following convention is adopted for each body X: 


Roll: 

A 

rotation 

of 

amount 

tH 

CD 

about 

an 

axis 

parallel 

to 

e xi 

Pitch: 

A 

rotation 

of 

amount 

6 X2 

about 

an 

axis 

parallel 

to 

e X2* 

Yaw: 

A 

rotation 

of 

amount 

6 X3 

about 

an 

axis 

parallel 

to 

®X3* 


Based on the latest design of the AMS, the relative orientation 
of body p to body X is assumed to be a result of the following 
rotation sequences of body y about axes parallel to the e unit 
vectors : M 


6 to Inertial Ref. Frame R: Roll, Pitch, Yaw (0 



A- 10 



Body 1 and 3 to Body 2* ; Yaw only ( 633 ) 

Body 4 to Body 3 :8 Yaw, Pitch, Roll ( 843 s ®42» ®41^ 
Body 5 to Body 4** : Roll, Pitch, Yaw (0^, ^ 52 ’ ® 53 ^ 


Having specified the necessary 

rotations , 

it is now 

possible t 

write the transformation matrices in 

equation (A-36) . Th« 

are: 







C 62 C 63 


C 6 2 S 63 


S 62 

M- 

C 61 S 63 + 

S 61 S 62 C 63 

C 61 C 63 " 

S 61 S 62 S 63 

" S 61 C 62 


. S 61 S 63 ' 

C 61 S 62 C 63 

S 61 C 63 + 

C 61 S 62 S 63 

C 61 C 62 . 


C 22 C 23 

C 22 S 23 C 21 + S 22 S 21 

C 22 S 23 S 21 

+ S 22 C 21 

M ■ 

S 23 

C 23 C 21 


" C 23 S 21 



_“ S 22 C 23 

S 22 S 23 C 21 

+ C 22 S 21 

“ S 22 S 23 S 21 + C 22 C 21 


fc 

-S O' 





33 

33 




M - 

S 33 

G 33 ° 

- M 




.0 

0 1 - 





* Because Body 1 counterbalances Body 3, these two bodies will 
always have the same orientation relative to Body 2, and hence 
only one set of Euler angles need be specified. 

**Body 5 (payload) is assumed fixed to Body 4 but may have an 
arbitrary orientation relative to same. 


(A-37) 


(A.-38) 


(A-39) 
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M ■ 


C 43 C 42 C 43 S 42 S 41 " S 43 C 41 C 43 S 42 C 41 + S 43 S 41 

S 43 C 42 S 43 S 42 S 41 + C 43°41 S 43 S 42 C 41 " C 43 S 41 


-S 


42 


C 42 S 41 


C 42 C 41 


(A-40) 


M 




C 52 C 53 


“ C 52 S 53 

S 52 



C 51 S 53 + 

S 51 S 52 S 53 

C 51 C 53 " S 51 S 52 S 53 

“ S 51 C 52 


(A-41) 

. S 51 S 53 " 

C 51 S 52 C 53 

S 51 C 53 + C 51 S 52 C 53 

C 51 C 52 . 



= sin 0 Aj 

and C . , ~ 
A 3 

cos 9,.. Because the 
A 3 

^E^ matrices 

\ 



are ort 


is an 


easy matter to obtain the other transormations implied by Equation 
(A-36) and hence are not written here. 


2. Kinematic a 1 Equations 

It can be seen from Equations (A-27) - (A-29) that Equations 
(A-30) - (A~35) are functions of the angular velocities of the 
various bodies relative to the inertial reference frame R. Be- 
cause the D vectors and the inertia dyadics , I, , are constant 

in the body A, it is advantageous to project the angular velocity 

vectors along axes parallel to the e . vectors. In other words 

A i 

we let 

“Xi = “x ' «Xi (A - 42) 


and to be consistent with the preceeding orientation specifications, 
we write: 



(A-43) 


A- 12 



(A-44) 



2 


ui 


3i| 


(A-45) 

(A-46) 


where the . (i = 1,2,3) are the projections of the angular 
A 1 

velocity of body X relative to body on the e . unit vectors, 

A , Ai 

or 


U 


Xi 



e x . (i = 1,2,3) 


(A-47) 


The a), . and W to, . are determined by the so-called kinematical 
6i Ai J 

equations relating the quantities to the appropriate Euler angle 
rates. For the aforementioned rotation sequences, the equations 
are: 


L I - Cr 1 ( e 1 
( w 6i) L R 6J j 0 6il 


1 6 ! _ r 

i W 2i) - [ 

R 2J 

(q ) 

( e 2ii 



)2 1 _ f 

1 u 3il ' i 

R 3. 

i; ! 

| 8 3ii 



! 3 I _ 
1 “41) ' 


•H 

• CD 



where 






f C 63 C 62 

S 63 

0 “ 

N- 

_< 

3 63 C 62 

C 63 

0 


L S 62 

0 

1 


(A-48) 

(A-49) 

(A-50) 

(A-51) 


(A-52) 
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0 



f'l 


s 


63 


0 C 23°21 S 21 


0 C 23 S 21 C 2 




1 0 

0 C 41 

0 -S 


-s 


42 


S 41 C 42 


41 C 41 C 42j 


(A-53) 


(A— 54) 


(A-55) 


Now, as mentioned at the end of Section C, Equation (A-35) 
must be integrated before Equations (A-30) - (A-34) can be 
evaluated, and to do this numerically, Equation (A-35) must be 
put into the following form: 


6i 


= f(w 6 .) (i = 1,2,3) 


(A-56) 


which means that when those terms in Equations (A-30) - (A-35), 
which are dependent upon the u>g^, are written; the dependence 

on the must be shown explicitly. For this reason, the 

derivatives of the angular velocity vectors are written as follows: 


“Xij - [ w x] j“6ij + j W X 


(A-57) 


where 


“Ai = “A 


• e 


Ai 


(A-58) 


A- 14 



It follows from Equations (A-43) - (A-46) that 


H- M 

(A-59) 

( W 2 j ■ f 2 ® 6 ] Hi! + jkij 

(A-60) 

H ■ H - M h] 

(A-61) 

Hi - Hi ■ k 2 ] l“2i! + [ v ] Hi + | 2 “3i} 

(A-62) 

M ■ [ v i H 

(A-63) 

k! ■ [ i? ] Hi! + M Hi + f“«J 

(A-64) 

H • [ v ] W 

(A-65) 

ksi - f v ] Hi 

(A-66) 

where the are obtained by differentiating Equations (A-49) 

- 

(A-51) . * > 


3. Inertia Dyadics and the Vectors 


The inertia dyadics, I , appearing in Equation (A-29) can be 



evaluated directly from (A-16) , but first, the components of the 
and . vectors are defined by 


D Xj = h * S Xi = 1.2,3) 


(A-67) 
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(i = 1,2,3) 


(A-68) 


D — D * e 
Aji Aj Ai 

and the elements of the inertia dyadic I are defined by 

A 

3 

*A I Ai e Ai e Ai ^ = 1 ’ 2 ’* # * ’ 

i=l 


(A-69) 


since it was assumed the e , are parallel to the principal axes 
of body A for its mass center. Finally, the elements of I inertia 

A 

dyadics are given by: 


X A 



3 

* 

2^ X AjK e Aj e AK 
K=1 


(A-70) 


and an associated matrix is defined by 





it 

it 

I A11 

I A12 

I A13 

* 

T 

it 

it 

A21 

1 X22 

I A23 

* 

it 

it 


I A32 

I A33_ 


(A-71) 


Using the definitions given by Equation (A-29) and Equations (A-67) - 

(A-71), the following expressions are obtained for the elements of 
* 

the [1^] matrices: 
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Body 1 


I 11 + m l (°12 + °13) + m ll (°112 + °113) 
- ^ 1 D n D 12 + m u D 111 D 112 j 

"^ m l D ll D 13 + m ll D lll D 113j 


* * 
I 121 = I 112 


I 122 I 12 + m l ( D ll + °13) + m ll ( D lll + D 113, 

j^ m l D 12 D 13 + m ll D 112 D 113j 


I 123 " m l D 12 D 13 + m ll D 112 


I 131 I 113 


* * 
*132 = I 123 


I 133 I 13 + m l ( D 11 + D 12 ) + m H ( D lll + °112 


Body 2 


* / 2 2 \ / 2 2 / 2 2 
I 211 “ T 21 + m 2 ( D 22 + D 23 ) + m 21 \ D 212 + °213 J + m 22 \ °221 * °223 


+ m 23 ! D 232 ' + D 233 ; 


I 212 ” m 2 D 21 D 22 + m 21 D 211 D 212 + m 22 D 221 D 222 + D 23 D 231 D 232 


I 213 ~ m 2 D 21 D 23 + m 21 D 211 D 213 + m 22 D 221 D 223 + m 23°231 D 233 


* * 
I 221 = I 212 
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22 

+ m 2 ( 

°21 

1 

l 23 

( D 231 

+ d: 


l ) + m 21 (°211 + D 213 ) + m 22 ( D 221 + ° 223 ) 


•[ m 2 D 2 


I 223 “ m 2 D 22 D 23 + m 21 D 212 D 213 + m 22 D 222°223 + m 23 D 232 D 233 


* * 
I 231 = I 213 


* * 
I 232 = I 223 


*233 = X 23 + m 2 ( D 21 + 


( D 21 + ° 22 ) m 21 (°211 + ° 212 ) + m 22 ( D 221 + D 222 j 

( D 231 + °232) 


+ m 23 i D 231 + °232 


Body 3 

‘ 31.1 = I 31 + m 3 (°32 + ^ 33 ) + m 33 ( D 332 + °333) + m 34 (°342 + °343) 


312 
* 

*313 = 

* 3 k 

I 321 = I 312 


^m 3 D 3i D 3 2 + m 33 D 33 1 D 332 + m 34 D 341 D 342] 
[ m 3 D 


31 D 33 + m 33 D 331 D 333 + m 34 D 341 D 343 


] 


322 
* 

I 323 

3 k 

I 331 = I 313 


I 32 + m 3 1 D 31 + D 33) + m 33 ( D 331 + °333) + m 34 l D 341 + D 343 j 


( D 31 + ” 33 ) + "33 ( 
[ m 3 D 32 D 33 + 


m 33 D 332 D 333 + m 34 D 342 D 343 


) + m 34 (‘ 

] 


CA-73) 

(cont) 
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* 

[ 332 

* 

C 333 


= I 


323 


I 33 + m 3 


(’ 


31 + D 32/ + m 33 l°331 + 


(°331 + D 332) + ®34 (°341 + °342) 


Body 4 

I 411 = I 41 + ®4 (°42 + °43) + m 44 ( D 442 + D 443) + *45 (°452 + D 453j 

] 


*412 " m 4 D 41 D 42 + m 44 D 441 D 442 + m 45 D 451 D 452 


* * 
I 421 = 1 412 


423 


2 + ”4 ( D 41 + D 4 3 ) + "44 ( D 441 + D 44 3 ) + M 45 ( D 451 + D 45:) 
[ m 4 D 42 D 43 + "41 D 442 D 44 3 + B 45 D 452 D 45 3 ] 


^ ft 

I 431 = I 413 


ft ft 

I 432 = I 423 


I 433 “ I 43 + m 4 (°41 + D 42 ) + m 44 ( D 441 + D 442) + m 45 ( D 451 + D 452) 


Body 5 


I 511 ~ I 51 + m 5 (°52 + °53 ) + m 55 ( D 552 + °553) 
512 = ~ [ m 5 D 51 D 52 + m 55 D 551 D 552] 

[ m 5 D 51 D 53 + m 55 D 551 D 553] 


513 


ft ft 

X 521 = I 512 


(A-74) 

(cont) 


(A-75) 
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I 522 X 52 + m 5 ( D 51 + D 53) + m 55 (°551 + °533) 


523 


[ m 5 D 52 D 


53 + m 55 D 552 D 553 


* * 
I 531 = I 513 


?v * 

I = I 
532 1 523 


533 I 53 + m 5 (°51 + °52) + m 35 (°551 + °552) 


Body 6 

1611 - r 61 + “6 ( D 62 + D 6 3 ) + "62 ( D 622 + 4 3 ) 


612 " m 6 D 61 D 62 + m 62 D 621 D 622 


I 613 ' m 6 D 61 D 63 + m 62 D 621 D 623 j 


>V Vc 

I 621 = X 612 


622 

X 62 + m 6 \ 61 + 1 

* 1“ 

623 

[ m 6 D 62 D 63 + m 62 J 

* 

* 

631 = 

r 613 

* 

* 

632 = 

X 623 

* 

/ 2 

623 = 

X 63 + m 6 \ 61 + D 


(A-76) 

(cont) 


(A-77) 
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With the inertia dyadics I. defined, it is possible to 

A 

evaluate the N. vectors in Equation (A-29) . Once again, to show 
A ^ 

the dependence on explicitly, we write: 


M -[X] N + \A 

where 



'XI 


(A-79) 


Before writing the 


IX] and i ji j 


expressions, it is helpful to 


define_a "cross product" matrix as follows: Consider two vectors 

A and B with components in a reference frame X given by: 



B. 

1 


'Xi 


(i = 1,2,3) 


where the e^ (i = 1,2,3) are mutually perpendicular unit vectors. 

— » f\j 

The cross product matrix associated with A is denoted by A and is 
given by 



(A-80) 


Now if a third vector 


C is defined by 


C = A x B 


it follows that 



where 


c. = c • e Xi (i = 1,2,3) 

Using the above convention along with Equations (A-29) , (A-5 7 ) , 
(A-71) and (A-78) we have 


/] j\j [Wx] (A ~ 1,2 » • * ” 5) 

■ K][ w i] + [“>] t 1 *] ki!> < x * I*- • • •• » 


M 


and 

IX]- 

r 

h 

Wr 

“ 6 . 


[■:] 


6 i 


(A-82) 

(A-83) 

(A-84) 

(A-85) 


4. The and Vectors 

The M. vectors in Equation (A-27) depend on the D. , which, in 

A , A J ■ 


turn, depend on tog as seen from Equations (A-20) and (A-61) . Be- 
this the i 

Ai] ( 4 i 


cause of this the D . are written as 


where 


|al 6ij + 


J , jeJ(X), (X - 1,2, . . .,5) 


(A- 86 ) 


D . . = D * e.. . 
X 31 Xj Xi 


(i = 1,2,3) 


(A-87) 


Using the cross product matrix defined by Equations (A-80) and 
(A-81) and Equations (A-20) and (A-47), the H and|^^r' ^ j. 

can be written L J - 


i]--[k][ w *] 3EJCX) ' <x 


= 1 , 2 , 


. ,5) 


(A- 88 ) 
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jgfe] ’ - [®6 2 ] 

b' 62 ! ’ [\] [“ 6 ] | D 62ij 

Having the D , in hand, the .5 vectors can be written as 

AJ A 

{ M U ! = p^x] {“6ij + \jh J* (A = 1 ’ 2 ’ • • *’ 6) 

where 

M U - 5 » ■ S *i (i - 1 ' 2 - 3 > 

Combining Equations (A-27), (A-86) and (A-92) we arrive at 

>1] ■ M [ S n] [ 3e2 ] [^21] + [^33] + [ V ] W + [ 3e5 ] E%] 

+M [■%]_ 

X 2 ] - M L S 2l] M fe] + M [ fe 2 3 ] _M [%] + M KJ 

+ M te]_ +m [ s 22 ] M [•%] 

m - “[”33] 1^1 ] + m w + m [■%] 

+ 4 ^ 4 ] m + [ 3e5 ] fei 


(A-90) 

(A-91) 

(A-92) 

(A-93) 
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kl - “[* J . M fed + M [%] + M fed 
+ 1 4 ® 3 ] fed + m M M fed 

ui - «[y N fed - m fei ♦ m fei 

kM*d [M [Wd fe]+ M Ife] 
- M fed + M fedl 


The expressions |-def ined by Equation (A-92) are obtained 


from thep^J equations above simply by replacing the ] matrices 

with {D* } matrices. 

5. External Forces and Torques and the L Vectors 

To evaluate the components of the vectors in Equation 
(A-28), the external forces and torques, F. and T , must be 

A A 

specified. The components of the external torque vector, T^ , are 

A 

defined by 

T Xi = *X ' S Xi ^ = l52 ’ 3 ^ ^ A " 

The external force acting on body A, F , is written 

A 

F x = F Xg + F' x (X = 1,2, . . .,6) (A- 

where F^ g is the gravitational force and is any other external 

force acting on body X. If the components of the F, are defined by 

Xg 

F Xgi = F Xg ' e Ai = 1,2,3) (A ' 
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and if the components of the gravitational acceleration vector, 
g R , in inertial space, are defined by 


g Ri ' g R ’ e Ri (1 ’ 1 - 2 - 3 > 


it follows that 



The components of F’ are written 

A 

*Ai = *A * e Ai ^ = 1 ’ 2 ’ 3 ^ 


(A-103) 


(A-104) 


(A-105) 


Finally, the components of the total external force vector acting 
on body A is given by 





where 


(A = 1,2, . . 6) 


F 


Ai 



'Ai 


(i - 1,2,3) 


(A-106) 


(A-107) 


, . c . , and g_., one is able to apply 

Thus, by specifying the T, . , F\ . 6 Ri’ vv 1 

Al AX 

any set of external force and torques to each of the bodies as well 
as specify an arbitrary gravitational force (including zero) , 


By means of Equation (A-28) , the components of the L vectors 

A 


can be written in terms of F and T . as follows: 
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where 


L X1 ~ L X * e Xi ’ ^ 1,2,3) 
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6. Joint Torques and the Differential Equations for 


Having expressions for the components of the M. , L , and 

vectors, it is now possible to evaluate the joint torques given 

by Equations (A-30) - (A-35) • First the components of the joint 
torques are written 

| T Xji( = [ T Xj] l“6i| + | T Xjj (X = 1,2 » * * *» 6) 


a 
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- 112 ) 


-113) 


-114) 


.-115) 


A- 26 



where 


T Xji - - hi (i ■ 1 ’ 2 ’ 3 > (A - 116) 

and using Equations (A- 30) - (A-34) , (A-78) , (A-92), and (A-114) , 


the *n . and *r' • can be written: 
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The differential equation (A-35) for ui, 

0 

follows: 

can now be written as 

M U - We! ■ 0 

(A-135) 

where 
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and 
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Finally, solving (A-135) for 
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which is the desired form for numerical integration. 
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Now, once the are obtained by integration of Equation 
(A-139) , the Euler angles, 0^, can be determined by integrating 
Equation (A-48) as follows: 



(A-140) 


which completes the determination of the rotational motion of 
body 6. 

— H 

Finally, the joint torques, T, . , are now easily obtained by 

Aj 

substitution of the and into Equation (A-43) , 

7. Joint Forces 

_H 

The forces of interaction at the joints, F^ , can now be 

determined in the following way: First, the . vectors are 

A 3 

determined from Equation (A-86) . Then from the definition of the 
barrycenter vectors and we can write 
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which enables one to determine the D, from the D, At this 

m - A Aj 

point, the p^ ~ p accelerations can be determined from Equation 
(A-18) ; they are 
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Finally, by expanding Equation (A-17) we have for the hinge inter- 
action forces 
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8. Motor Torques 

Torque motors are assumed to drive the various gimbals at 
Joints 2, 3 and 4. The motor torques to produce the specified 
motion are determined by projecting the appropriate hinge inter- 
action torques along the motor axes. The results are: 

Joint 2 


(Pitch Motor Torque, 

c t h = s t h 
zlz22 a 21 z23 
M = 

C 23 

(Yaw Motor Torque, 

H H 

M — c T _u r t 

22 a 21 222 ^21 223 
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(Roll Motor Torque, 


H 

M = T — Q M 
23 221 23-1 


(A-164) 


Joint 3 

The motor at Joint 3 must drive the pitch motion of both 
bodies 1 and 3 and hence the required pitch motor torque is 

„ , m H 

M = T + T 

33 333 113 


Joint 4 

(Yaw Motor Torque, M^) 

M 41 ‘ ( T M2 S 41 + x 443 C 4l) 
(Pitch Motor Torque, M^) 


42 


M - T^ C - T^ q 
42 442 41 443 b 41 


(Roll Motor Torque, M^) 
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Equations (A-162) - (A-164) and (A-166) - (A-168) for joints 
2 and 4 are valid only in the absence of external forces and torques . 
When such influences are present, it is necessary to identify that 

portion of the T^' due to external forces and torques and that por- 
tion necessitated by inertia forces (the motion). To this end, we 
”H -h 

define T, as that part of T due to external forces and torques 
_ H *JE _ H *1 

and T.. t as that part of T due to inertia forces. It follows 
aj l A j 

that 
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Now it can be seen from Equations (A-27) - (A-35) that the con- 

— H 

tribution of external forces and torques to the T . is contained 

A J 

in the vectors only. It therefore follows from Equations (A-30) 
(A-35) that 
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Equation (A-169) can now be used to determine the T T . We now 
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define 


t h = t h . ; 
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Now, for the three gimbal joints (joints 2 and 4), only that 
which is parallel to a particular gimbal axis 


— H 

component of T „ 

AJ & 


at joint j contributes to the motor torque associated with that 
gimbal axis. The remaining two components are absorbed as con- 


straint torques. 


_H 

On the other hand the entire T.. vector must 

Aj I 


be produced by the torque motors at a three gimbal hinge j. 

This requirement results in equations like (A-162) - (A-164) and 

(A-166) - (a-168) with the T®. . replaced by T® . . 
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Thus when external forces are present, the motor torque 
equations for joints 2 and 4 become 
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c T — C T 
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APPENDIX B - 7 -DOF JOINT ORDERING CONTROLLER BREADBOARD 


A mechanism was devised which allowed examination of 
various control device configurations of a 6 -DOF bilateral, 
non-counterbalance, geometrically similar master controller. 
The configurations were evaluated for joint ordering segment 
lengths, joint travel and overall configuration. 

This section presents the configuration and design of a 
joint ordering controller; next it is shown how the erector 
set type joints were first used as a slave manipulator; and 
then finally the apparatus was reconfigured as a controller. 
Incidently, another variation resulted which required some 
modification of the basics by addition of a vertical transla- 
tion mode. This final scheme was then converted into a 
recommended final floor mounted 6-DOF controller* 


1. Requirements for Breadboards 

The following lists the guidelines for this test tool. 

(1) Device to represent full scale controller with some 
telescoping capability for length extensions. 

Lengths to be compatible with SAMS control area. 

(2) Device to have a minimum of six joints, each of which 
represents an approximate length required for a force 
feedback servomechanism. 

(3) Device to sense position (angular) only for each joint 

(4) Joints to be interchangeable to allow any order of yaw 
pitch, roll, etc . 

(5) Locking or braking was provided to either lock out 
any joint or represent a frictional drag. 

(6) Device to use light weight aluminum material where 
feasible, ball bearing joints, yoke design, common 
flange mounts. 

2. Design of the Joint Ordering: Test Mechanism 

It was decided to provide seven degrees of freedom (i. e. , 

7 joints) for utmost versatility. Drawing RES3156200 , 
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shows these joints assembled. There are four identical yaw or 
pitch joints. Assembly Drawing RES3156201, and three identical 
roll joints assembly Drawing RES3156202. RES 3156200 install- 
ment drawing shows these joints in the following order starting 
from the handle: 

(1) Wrist Roll Control (using pitch type yoke joint) 

(2) Wrist Pitch Control (using pitch type yoke joint) 

(3) Wrist Yaw Control (using rotary type joint) 

(4) Elbow (using rotary type joint) 

(5) Shoulder Yaw (using rotary type joint) 

(6) Shoulder Pitch (using pitch type joint) 

(7) Shoulder Roll (using pitch type joint) 

Sum = 4 pitch type yoke joints + 

3 rotary type joints. 

Telescoping is provided as shown, from 4 1/8 to 8 inches 
on 2 segments. 

All flanges have the same bolt circles and by orienting 
two pitch hinge assemblies 90 apart they become a pitch-yaw, etc. 

One half inch plastic, single stage, continuous, infinite 
resolution potentiometers are used throughout and are easily 
indexed . 

Braking on the roll joints is provided by a brake shoe 
(oilite bearing) which is clamped by 3 equispaced locking screws 
on the housing circumference. 

Braking on the pitch hinges is provided by split ring 
collars using an adjustment screw to increase shaft friction. 

Prior to design joint motors and gearing were investigated 
so that the breadboard joint sizes could be representative of 
actual joint sizes. 
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3. Joint Ordering Breadboard Mechanism as a Slave Manipulator 

As soon as the mechanism parts were completed and the 
joints were assembled it was decided to use the mechanism, 
first as a manipulator model for evaluating cargo deployment. 

See Section II B&C. Figure B-l shows the first assembly 
using the first telescoping tubes. These tubes were extended 
to represent a scaled slave arm. Naturally the control handle 
was not used. 

4. Joint Ordering Breadboard Mechanism as a Master Controller 

Upon completion of the manipulator joint angle and reach 
study the parts were reassembled in the form of Dwg. RES 3156200 
with the handle added and was used to evaluate the order of 
joints has a master controller. Figure B-2 shows one position 
that the controller was evaluated. 

5. Modified 6-DOF Bilateral Controller Breadboard (Final Version) 

Evaluation of the controllers described previously led to 
the modified arrangement as discussed here. The controller 
was mounted on the floor rather than on the control console or 
armrest. This produced the joint order as follows: 

Hand 1 e 

Wrist roll 
Wrist pitch 
Wrist yaw 

Vertical elbow translation 
Shoulder yaw 
Shoulder pitch 

The advantages and evaluation of this design are discussed 
in section V. 

This section discusses the design and hardware aspect of 
this controller. Figure B-3 shows the breadboard. The 
"shoulder” joints are at floor level. Dual rods offered a 
simple method for producing linear bearing support which is 
nonrotatable. A crossplate containing linear bushings, the 
translational rod and a gear rack are capable of being extended 
approximately 15 inches. The rack is used to drive a pinion 
upon whose shaft another 1/2 inch (10 turn) potentiometer is 
attached. This is used to read translational position. All 
joints excepting the translational are the same ones used in 
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the original joint ordering breadboard, except they are assembled 
in a different order with revised bracketry. The handle has been 
repositioned from that described in the 6 -DOF Bilateral Force 
Feedback controller, in that the three axis intercept is at the 
center of the hand rather than at the operator* s wrist pivot 
point. 

For this configuration joint scaling is no longer completely 
valid. Those joints at the floor must be capable of larger 
torques because of the longer total arm length. However, for 
preliminary studies the breadboard, with its potentiometers at 
each joint, provide a useful evaluation tool. 
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Figure B-3 Telescoping 6 DOF Controller (Modified from 
6 DOF Joint Ordering Mechanism) 



APPENDIX C. VIDEO SYNTHESIZER 


In order to evaluate various master controller configura- 
tions without involvement of the moving base simulator, a gen- 
eral purpose Video Synthesizer (VS) was constructed. The VS 
provides a display of 4 dots and 2 crosshairs which are displaced 
from the center of the screen (0, 0, 0 position) by dc command 
voltages. The VS may be configured to provide any of the fol- 
lowing presentation modes: 

1. Planar 

a. Monochrome 

b. Color 

2. Stereo 

a. Dual monitor (Fresnel, lenticular, etc.) 

1) Monochrome 

2) Color 

b. Single monitor--split screen 

1) Monochrome 

2) Color 

c. Single monitor--color .separation 

In the simulation system, one dot represented the target; the 
other two dots are used to show end effector translational pos- 
ition; the crosshair represented the end effector orientation 
(pitch and yaw) and was considered pointing at the target when 
the crosshairs and the target dot were coincident. 

The VS was first used in the dual monitor stereo mode. 

This mode, however, proved unsatisfactory from a human factors 
standpoint. It was found difficult to converge on spots of 
light in different planes. An alternative method based upon a 
color depth indication was devised. 
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The target in this conf iguration was represented by a single 
blue dot on a color monitor. The end effector position was represented 
by a white cross. The end effector translation was represented 
by two dots -- one red and one green -- the horizontal separa- 
tion of which represented the distance from the depth plane of 
the target. When the manipulator end effector was closer to 
the "camera" than the target the green dot was to the left of 
the red dot as in Figure C-la # As the end effector moved out, the 
green and red dots would move closer together until, as in Fig- 
ure-C-lb, the dots would merge into a single yellow dot when the 
end effector and target were in the same depth plane. If the 
end effector were moved farther out, the two dots would re- 
appear; this time the red dot would be to the left of the green 
as in Figure C-lc. Thus, the necessary depth information was dis- 
played without the convergence difficulties encountered using 
stereo. This method was used for the controller evaluations. 


Figure-C-2 is the VS block diagram. The inputs are analog 
voltages from a computer. The generation of the crosshair is 
the simplest. Thg X command for the crosshair to be seen by 
the left eye is X^. When the input from the Horizontal Sweep 
Generator is more negative than the Comparator output is 

zero. The Horizontal Sweep Generator produces a linear saw- 
tooth which starts at -10 volts and sweeps in a positive direc- 
tion to +10 volts. This process is repeated 15,750 times per 
second. Each sweep corresponds to one horizontal line on the 
face of the monitors. Assume x£ = 5.0 volts. As soon as the 
output of the Horizontal Sweep Generator becomes more positive 
than 5.0 volts the Comparator output goes high and triggers the 
Pulse Generator. The pulse produced causes a white spot to ap- 
pear on the otherwise dark monitor screen. Since this process 
occurs once during each horizontal line, at the same X displace- 
ment on each line, the result is a white vertical line on the 
screen. 

Now let us see how the horizontal line of the crosshair 
is developed. A similar comparison is used to determine the Y 
component of the crosshair. The Vertical Sweep Generator pro- 
duces the same kind of -10 volt to +10 volt sawtooth except 
that it occurs 60 times per second and corresponds to the moni- 
tor vertical scan. As soon as the sweep voltage goes positive 
with respect to the command the Comparator switches from 
zero to high. However, the Gate holds the Comparator output 
from triggering the Pulse Generator until the beginning of the 
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next horizontal scan line, to avoid a scan line which is part- 
ially black, partially white. During the horizontal blanking 
interval the Gate opens and triggers the Pulse Generator . The 
pulse duration allows one scan line to appear white -- the hor- 
izontal portion of the crosshair. 

The dot generation is similar except that the output of 
the Y Pulse Generator is used to gate the X pulses. For ex- 
ample, the xj Comparator will produce an output during each 
horizontal line. However, it does not trigger a pulse because 
the Gate is held closed by the output of the Pulse Generator. 
When the Y^ Comparator goes high and the n^xt horizontal line 
begins, the X^ Gate opens and allows the X^ Comparator output 
to trigger the Pulse Generator and produce a dot ^n the monitor 
screen. At the end of that horizontal line the Y 1 goes back to 
zero and closes the x£ gate. Thus only one dot appears on the 
screen rather than a whole sequence as in the case of the cross- 
hair. 

Timing for the Horizontal and Vertical Sweep Generators is 
provided by the crystal-controlled Sync Generator. A synchron- 
izing signal which becomes part of the composite video is sent 
from the Sync Generator to the Output Summing Amplifiers. 

The Output Summing Amplifiers are an array of 12 video 
amplifiers with an input matrix which provides the proper com- 
bination of signals -- including sync -- at the output. All 
the outputs can be used simultaneously or separately. 
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Figure C-l Color Video Monitor Displays 


r 

blue 

end effector target 

g'reen red 1 

H 

J 


a. End effector closer than target plane 



blue 

end effector target 

yellow 

Hj 

J 
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c. End effector farther out than target plane 
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X = HORIZONTAL COORDINATE R = RIGHT 


Y = VERTICAL COORDINATE 

FIGURE C-2 VIDEO SYNTHESIZER BLOCK DIAGRAM 
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APPENDIX D - BREADBOARD DIGITAL PROGRAM 


This appendix presents a listing of the Fortran IV digital 
program that was used as a time domain design tool in the servo 
system fabrication of the two DOF breadboard manipulator. 
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Appendix D - Two D.O.F. Bilateral Control System Digital Program 


PROGRAM BIL AT ('INPUT, OUTPUT, TAPE5- INPUT , T APE6=0UTPUT , FIL MPL ) 

C*** MAIN PROGRAM FOI* 4 JOINT BILATERAL FORCE REFLECTING SYSTEM 
C 

DIMENSION X (8) , OX (8) , KT(4 ) , RT (4) , KG (4),CV(2) ,MV(2) , J1 (2,2) , 

1 J2 ( 2, 2) , JM( 4) ,KB( 4) , 

2 PT ( 10 2 3 ) » PX 1 ( 1 0 2 0 ) , PX2 ( 10 20 ) , PX3(1 020) ,PX4(1020 ) , 

3 PX5 ( 1 02 0) ,PX6(102Q) ,PX7 (1 02 0) , PX8 ( 1 020 ) , P XC 1 { 1 0 20) , 

4 PXD 2(1020), PXM1 (1020) ,PXM2( 1020 ) ,PXCD1 (10 20) , 

5 PXC02 (102 0) , PXMD1 (10 20) ,PXMD2 (1020) ,XC (2) ,XM(2) ,XCO (2) , 

6 X MD ( 2 ) , PT Qi ( 10 2 0 ) ,PTQ2(1020 ) ,PTQ3 (1020) ,PTQ4(10 20) 
COMMON/BLK1/KFB(4) ,KEI (4) ,K1 (2,2) ,<2(2, 2) ,K3(2,2) ,K4(2,2) ,K5(2,2) , 

1 K6( 2,2) ,MM (2,2) ,PI (2) ,RR(2) ,CT(2,2),CTI (2,2) ,GS(4), 

2 CA 1.2 , 2) ,MA(2,2) ,FC(2) ,FM(2) , OTC , OTM, LC , LM,KFL (4) , 

3 RL ( 4) ,TL(4),T0(4) 

REAL KFL ,KFB,<EI, K1,K2 ,K3 ,K4,K5,K6,MM ,MA,LC,LM,KT,KG, JM,MV,J1,J2, 

1 KB 

EXTERNAL FIRDER 
C**»READ IN ALL DATA 


READ (5,1) <1 
1 FORMAT (4F10.3) 


FORMAT (4F10.5) 

READ 

(5,1) 

<2 

READ 

(5,1) 

<3 

READ 

(5,1) 

<4 

READ 

(5,1) 

<5 

READ 

(5,1) 

<6 

READ 

(5,52) 

CA 

READ 

(5,52) 

MA 

READ 

(5,1) 

MM 

REAO 

(5,1) 

GS 

READ 

(5,2) 

PI 

FORMAT (2F10.3) 

REAO 

(5,2) 

RR 

READ 

(5,1) 

KT 

READ 

(5,1) 

RL 

READ 

(5,1) 

TL 

READ 

(5,1) 

RT 

READ 

(5,1) 

KG 

READ 

(5,52) 

KB 

READ 

(5,1) 

JM 

READ 

(5,3) 

RA 


3 FORMAT (F10.3) 

READ (5,2) LC ,L M 
READ (5,3) STIME 
READ (5,4) NEQ, ST EP 

4 FORMAT ( 12, FI 0 » 3) 
READ (5,3) T 
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READ (5,5) X 

5 FORMAT (8F10.3) 

READ (5,2) FC 
READ (5,2) FM 

C***WRITE ALL INPUT DATA TO VERIFY 
WRITE (6,6) 

6 FORMAT (1H1,5X,*TW0 DIMENSIONAL BILATERAL MANIPULATOR PROGRAM*/) 
WRITE (6,7) 

7 FORMAT ( 5X, *INPUT OATA*/) 

WRITE (6,8) 

8 FORMAT (5X»*K1*,28X,*K2*) 

DO 9 1=1,2 

9 WRITE (6,10) (Ki(I,J) , J=1 ,2.) , (K2 ( I , J) , J = 1 ,2) 

1C FORMAT ( 5X, 2 (Fl 0» 3, 3X , F10 • 3 » 7X) ) 

53 FORMAT ( 5X, 2CF1 0. 5, 3X, F10 *5 , 7X) ) 

WRITE (6,11) 

11 FORMAT ( /5X , *K3 *» 28 X, *K4* ) 

DO 12 1=1,2 

12 WRITE (6,10) (K3 ( I , J) , J=i , 2) , (K4 (I, J) , J= 1 , 2) 

WRITE (6,80) 

80 FORMAT ( /5X , *K5 * , 28X , *K6* ) 

DO 81 1=1,2 

81 WRITE (6,10) (K5( I, J) , J=1 , 2) , (K6 ( I, J) , J = 1 ,2) 

WRITE (6,82) 

82 FORMAT ( / 5X , * C A * » 2 8 X , * M A * ) 

DO 83 1=1,2 

83 WRITE (6,53) (C A( I, J) , J=i , 2) , (MA ( I , J) , J=1 , 2) 

WRITE (6,84) 

84 FORMAT (/5X,*MM*) 

DO 85 1=1,2 

85 WRITE (6,86) (MM( I, J) , J=i,2) 

86 FORMAT ( 5X, F10 . 3, 3X ,F 1 0 . 3) 

WRITE (6,13) 

13 FORMAT (/5X,*GS*) 

WRITE (6,14) (GS( I) ,1=1,4) 

14 FORMAT (5X,4(F10. 3, 3X)) 

54 FORMAT ( 5X, 4 (FI 0 . 5, 3X ) ) 

WRITE (6,15) 

15 FORMAT (/5X,*PI*) 

WRITE (6,16) CPI C I) ,1 = 1,2) 

16 FORMAT ( 5X, 2 (Fi 0 • 3, 3X ) ) 

WRITE (6,17) 

17 FORMAT (/5X,*RR*) 

WRITE (6,16) (RR( I) ,1=1,2) 

WRITE (6,19) 

19 FORMAT (/5X,*KT*) 

WRITE (6,14) (K T ( I) ,1 = 1,4) 

WRITE (6,21) 

21 FORMAT ( /5X , *RL *) 

WRITE (6,14) (RL(I) ,1=1,4) 

WRITE (6,23) 

23 FORMAT (/5X,*TL*) 

WRITE (6,14) (TL (I) ,1 = 1,4) 
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WRITE (6,25) 

25 FORMAT (/5X,*RT*) 

WRITE (6,14) ( R T ( I ) ,1=1,4) 

WRITE (6,26) 

26 FORMAT (/5X,*KG*) 

WRITE (6,14) (KG ( I ) ,1=1,4) 

WRITE (6,40) 

40 FORMAT (/5X,*K3*> 

WRITE (6,54) (KB( I) ,1 = 1,4) 

WRITE (6,27) 

27 FORMAT (/5X,*JM*) 

WRITE (6,14) ( J M ( I) ,1 = 1,4) 

WRITE (6,28) RA 

28 FORMAT (/5X,*RA = * ,F1Q.3> 

WRITE (6,29) LC,LM 

29 FORMAT (/5X,*LC = * ,F 1 0 . 3 ,3X , *L M = *,F10.3) 

WRITE (6,30) STIME 

30 FORMAT (/5X,*STIME = *,F10.3) 

WRITE (6,31) MEQ, STEP 

31 FORMAT (/5X,*NEQ = * , 12, 3 X, *STEP =* ,F10. 3) 

WRITE (6,32) T 

32 FORMAT (/5X,*T = *,F1Q .3) 

WRITE (6,33) 

33 FORMAT ( /5X , * X( 1) *, 9X , *X ( 2) * , 9X , *Xt 3) *,9X , *X (4) * ) 
WRITE (6,34) (X (I ) , 1=1,4) 

34 FORMAT ( 5X, 4 ( FI 0 . 3, 3X ) ) 

WRITE (6,87) 

87 FORMAT ( /5X , »X ( 5) *, 9X , *X (6) * ,9X , * X ( 7) * ,9X ,*X ( 8) * ) 
WRITE (6,34) (X (I), 1 = 5, 8) 

WRITE (6,35) 

35 FORMAT (/5X,*FC*) 

WRITE (6,16) (FC ( I) ,1=1,2) 

WRITE (6,36) 

36 FORMAT (/5X,*FM*) 

WRITE (6,16) (FM(I) ,1=1,2) 

WRITE (6,37) 

37 FORMAT (5X,*END OF INPUT DATA*) 

C*** COORDINATE TRANSFORMATION MATRIX 

CT (1,1) =COS ( RA) 

C T ( 1 , 2) =-SIN { RA ) 

CT (2,1) =SIN (RA) 

CT ( 2 , 2) = COS (RA) 

C*** IN VERSE COORDINATE TRANSFORMATION MATRIX 
CTI (1,1) =CT (1,1) 

CTI (1 ,2 ) =CT (2,1) 

CTI ( 2,1 ) =CT (1,2) 

CTI (2,2) =CT (2,2) 

C*** CALCULATION OF COMPOSITE SERVO PARAMETER? 

DO 38 1=1,4 

38 KFL ( I ) = K T ( I ) * KG ( I ) 

DO 39 1=1,4 

39 KFB (I ) =KG (I ) *KB (I) 

KEI (1) = 1. 0/( 0. 842 6+ JM (1) ) 
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KEI (2>=i.0/(G.597l+JM (2) ) 

KEI (3)=i .0/ ( 1.8981+ JM (3) ) 

KEI (4) = 1.0/ (0.6 79 8 + JM ( 4)) 

WRITE (6,41) 

41 FORMAT (1H1 , 5X , *C OMPOSITE SERVO PARAMETER VALUES*/) 
WRITE (6,42) 

42 FORMAT (5X,*KFL*) 

WRITE (6,43) (KFL (I) , 1=1,4) 

43 FORMAT < 5X, 4 ( FI 0. 3, 3X ) ) 

WRITE (6,44) 

44 FORMAT (/5X,*KFB*) 

WRITE (6,43) (KFB (I) ,1=1,4) 

WRITE (6,45) 

45 FORMAT (/5X,*KEI*> 

WRITE (6,43) (KEI (I), 1=1,4) 

C***CALCULATION OF CIO AND MAN IP. (X,Y) TIP POSITION 
XC(i)=LC*COS(X(l) ) + LC* COS (X (1) + X(3) ) 
XC(2)=LC*SIN(X(i) >+LC*SIN(X(l)+X(3) ) 
XM(l)=LM*COS(X(5) ) +LM + COS (X(5) +X (7) ) 

XM ( 2 ) =L M + SIN ( X ( 5) ) +LM + SIN (X (5) +X ( 7) ) 

C++* JOINT VELOCITY VECTORS 
CV(1)=X (2) 

CV(2)=X (4) 

MV ( 1 ) =X (6) 

MV(2)=X (8) 

C***J ACOBIAN MATRICES 

Jl(l,l> =LC*(-SIN(X( 1) ) -S I N < X ( 1 ) + X ( 3 ) ) ) 

J1 ( 1 , 2) =LC* (-SIN(X(1) + X ( 3 ) ) ) 

J1 (2,1) =LC* (COS (X (l))+COS (X (1 ) +X ( 3) )) 

Jl( 2 , 2) =LC* (COS (X (1)+X (3) ) ) 

J2 ( 1 , 1) =LM* ( - SI N ( X ( 5) ) -SIN(X(5)+X (7)) ) 

J2 ( 1 , 2) = LM* (-SIN ( X ( 5) + X (7 ) ) ) 

J2 ( 2 , 1) =LM* (COS (X <5 ) ) +COS (X (5) +X (7) ) ) 

J2 ( 2 , 2) =LM* ( COS (X (5 ) + X (7) ) > 

C***CID AND MANIP. TIP VELOCITY 

CALL MMPROU ( Jl, CV ,XCO , 2 , 2 , 1 ) 

CALL MMPRDU ( J 2 , MV ,X MD ,2,2,1) 

M = 1 

P T ( M) =T 
PX1 (M) = X (1) 

PX2 (M) = X (2) 

PX3(M) = X (3) 

PX4(M)=X (4) 

PX5 (M) = X (5) 

PX6 (M) = X (6) 

PX7 (M)=X (7) 

PX8 ( M) = X ( 8) 

PXC1(M) =XC(i> 

PXC2 (M) =XC(2) 

PXM1(M) = XM ( 1 ) 

PXM2 ( M) = X M ( 2 ) 

PXCDKM) =XCD(1) 

PXCD2 (M ) = XCD( 2) 
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PXMDi(M) = XMD(1) 

P XH02 (M I = XMD ( 2) 

PTQ1(M) = 0.0 
PTQ2(M) =0.0 
PTQ3(M) =0.0 
PTQ4(M) =0.0 
STIME=S T IME-1 . 0 E- 06 

C***KUTTA-MERSON NUMERICAL INTEGRATION ROUTINE 

50 CALL DFEQKM(NEQ,T ,S TEP , X , FIROER, +1 . QE-06,+1. OE-O 6 , 2 0 , EX I T , , TRUE . ) 
IF (EXIT. EQ. 0.0) GO TO 90 

C***CALCULATION OF CIO AND MANlP, (X,Y) TIP POSITION 
XC(l)=LC*COS<X(l) ) + LC*COS (X(l)+X(3) > 

XC(2)=LC*SINCX(1) )+LC*SIN(X (D+X (3) ) 

XM(1)=LM*C0S(X(5) ) +LM*COS (X(5)+X (7) ) 

XM(2)=LM*SIN(X(5) ) +LM*SIN <X (5) + X(7) ) 

C***JOINT VELOCITY VECTORS 
CV(1)=X (2) 

CV(2)=X (4) 

MV ( 1) =X (6) 

MV(2)=X (8) 

C***JACOBIAN MATRICES 

Ji(i,l) =LC*(-SIN<X(1) ) -SIN<X(l)+X(3>) ) 

Jl(l,2) =LC* (-SIN ( X ( 1) +X ( 3 ) ) ) 

Jl(2,i> =LC* (COS (X (1) ) +COS (X ( 1 ) + X ( 3 ) > ) 

Ji ( 2 1 2) = LC* (COS (X (1 ) + X (3 ) ) ) 

J2(l,l) = LMM-SIN(X(5> ) -SIN( X(5) + X(7)> ) 

J2(1,2)=LM*(-SIN(X(5) +X<7>) ) 

J2(2>1) = LMMCOS (X (3)) 4-COS (X (5)+X(7) >) 

J2(2,2) =LM* (COS (X (5)+X (7) ) ) 

C***CIO ANO MANIP. TIP VELOCITY 

CALL MMPRDU(J1,CV ,XC0,2,2,1) 

CALL MMPRDU ( J2 » MV ,X MO, 2, 2,1) 

M = M + i 
PT(M)=T 
PX1 (M) = X (1) 

PX2 ( M) = X (2) 

PX3 ( M) = X ( 3) 

PX4(M)=X (4) 

PX5 (M) = X (5) 

PX6 (M) =X (6) 

PX7 (M)=X (7) 

PX8 ( M) =X ( 8) 

PXCi (M) =XC(i) 

PXC2(M)=XC(2) 

PXMi(M) =XM( 1 ) 

PXM2 (M) =XM( 2) 

PXCDi(M) =XCD(1) 

PXC02 (M > =XCD (2) 

PXMOi(M) =XMO(i) 

P XMD2 (M) =XMD ( 2) 

PTQi (M) =TQ(i) 

PTQ2(M) =TQ(2) 

PTQ3(M) =TQ(3) 
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P TQ4 (M) = TQ( 4) 

IF ( T .L T . ST I HE) GO TO 50 
WRITE (6,46) 

46 FORMAT ( 1 HI , 5 X , *0 UT PU T DATA*) 

C *** WRI TI NG JOINT POSITIONS AND VELOCITIES 
WRITE (6,47) 

47 FORMAT (5X,*MASTER AND SLAVE JOINT POSITIONS AND VELOCITIES*//) 
WRITE (6,48) 

48 FORMAT (5X,*TIME* , 8 X , *X ( 1 ) * , 11X , *X( 2) * ,1 1 X, * X ( 31 * , 1 1X,*X ( 4) * , 11 X , 

1 *X(5)*»11X,*X (6) * »11X » *X |'7) * , llX , *X ( 8) *) 

DO 49 1=1, M 

49 WRITE (6,100) P T ( I > ,P X 1 ( I > , PX2 (I ) ,PX3 (I ) , PX4 (I ) , PX5 ( I > ,PX6 (I > , 

1 PX7 (I ) ,PX8(I) 

100 FORMAT (5X,F6.3 ,8 (6X,F9.5) ) 

C***WRITING X TIP POSITIONS AND RATES 

WRITE (6,101) 

101 FORMAT ( 1H1 » 5X, *MASTER AND SLAVE X TIP POSITIONS AND RATES*//) 
WRITE (6,102) 

102 FORMAT ( 5 X, *T IME* , 8 X, *XC ( 1) * ,1 OX , *XC( 2) * , 10X , *XM ( 1 > * , 10 X , *XM ( 2) * , 

1 10X,*XCD( 1) * , 9X, *XCD ( 2) * , 9X ,* XMD ( 1) * , 9X, *XM D ( 2) * ) 

DO 103 1 = 1, M 

103 WRITE (6,100) PT( I) ,P XC1 ( I) , PXC2 ( I) ,PXM1 (I) , PXM2 (I) ,PXCD1(I), 

1 PXCD2 (I) ,PXMD 1 ( I ) ,PXM02 <I) 

C***WRITING JOINT TORQUES 
WRITE (6,104) 

104 FORMAT ( 1H1 , 5X, *M ASTER AND SLAVE JOINT TORQUES*//) 

WRITE (6,105) 

105 FORMAT (5X,*TIME* ,8 X , * TQ ( 1) * ,1 OX ,*TQ( 2) * , 10X ,*TQ( 3) * , 10X , *TQ ( 4) * ) 
DO 106 1=1, M 

106 WRITE (6,107) PT ( I) ,PTQ1 ( I) , PTQ2 ( I) ,PTQ3 ( I) , PTQ4 ( I ) 

107 FORMAT (5X, F6 . 3 ,4 (6 X , F9. 5 ) ) 

WRITE (6,51) M 

51 FORMAT (/5X»*M =* ,14) 

C***F INDING MIN. AND MAX. SCALE VALUES FOR PLOTTING 
CALL MI NMAX ( M ,PT , PTS , PTL ) 

CALL MI NMAX ( M , P XI ,P XI S ,PX 1L ) 

CALL MI NMAX (M , PX2 »PX2S »PX2L ) 

CALL MINMAX(M,PX3,PX3S,PX3L) 

CALL MI NMAX ( M , P X4 , P X4S , PX4L ) 

CALL MINMAX (M,PX5 ,PX5S,PX5L) 

CALL MINMAX (M,PX6,PX6S,PX6L) 

CALL MINMAX(M,PX7,PX7S,PX7L) 

CALL MINMAX (M,PX8 ,PX8S,PX8L) 

CALL MINMAX (M,PXC 1,PX CIS, PXC1L) 

CALL MINMAX (M,PXC 2, PXC2S, PXC2L) 

CALL MI NMAX (M,PXM1,PXM1S, PX MIL ) 

CALL MINMAX ( M , P XM 2 , PX M2S , PX M2L ) 

CALL MINMAX (M,PXCD1 ,PXCD1S,PXCD1L ) 

CALL MINMAX (M,PXCD2 , PXCD2S, PXCD2L ) 

CALL MINMAX (M»PXMD1 ,PXMD1S, PXM01L ) 

CALL MINMAX ( M , P XMD2 , P XMD2S , PXM02L ) 

CALL MINMAX ( M ,PTQ 1 , PT Q IS , PTQ1L ) 

CALL MI NMAX ( M , PTQ2 , PTQ2S , PTQ2L ) 
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CALL MINMAX(M,PTQ3,PTQ3S,PTQ3L) 

CALL MINMAX (M ,P TQ4, PTQ4S , PTQ4L > 

CALL SCALE(PTL,PtS,lC,PTG,PTT,Sl) 

CALL SCALEtPXIL ,P XI S , 1 0 , PX1 G , PXi T ,S2> 

CALL SCALE(PX2L,PX2S,1Q,PX2G,PX2T,S3> 

CALL SC AL E( PX3L , P X3 S, 1 0 , P X3G , PX3T ,S4) 

CALL SCALE(PX4L,PX4S, 10,PX4G,PX4T,S5> 

CALL SCALE(PX5L ,P X5 S, 1 0 ,PX5G ,PX5T ,S6> 

CALL SCALE(PX6L ,PX6S, 1 0 , PX6G, PX6T ,S7> 

CALL SCALE(PX7L ,PX7S, 10,PX7G ,PX7T ,S8) 

CALL SCALE(PX8L ,PX8S, 1 3 , PX8G, PX8T , S9> 

CALL SCALE{PXClL»PXClSflO ,PXC1G,PXC1T ,S10) 

CALL SCALE(PXC2L, PXC2S,10 , PXC2G , PXC 2T ,S1 1 ) 

CALL SCALE(PXM1L, PXMiS,iO ,PXH1G,PXM1T ,S12) 

CALL SCALE(PXM2L, PXM2S , 10 » PXM2G , PXM 2T ,S1 3) 

CALL SCALE(PXC01L ,PXCD1S , 10 , PXC01 G, PXCD1 T ,S1 4) 

CALL SCALE(PXCD2L ,PXCO2S,10 , PXC02G, PXCD2 T ,S15) 

CALL SCALEtPXHDIL ,PXHD1S,10 , PXM01G, PX HOI T ,S1 6) 

CALL SCALE(PXM02L ,P XM02S , 10 , PXMD2G, PX M02 T »S1 7) 

CALL SCALE<PTQ1L» PTQlSflO »PTQ1G, PTQlT ,S18 ) 

CALL SCALE(PTQ2L, PTQ2S,10 »PTQ2G,PTQ2T ,S19) 

CALL SCALE(PTQ3L,PTQ3S,10,PTQ3G,PTQ3T ,S20) 

CALL SCALE(PTQ4L, PTQ4S,10 ,PTQ4G,PTQ4T ,S21) 

c**»plot of master shoulder position 

CALL BPLT(0,2HLC) 

CALL SPL T (0.0, SI, 4H TI ME, 2 4HMAS TER SHOULDER POSIT ION ,0 1 PX 1 T, 

1 PX1G» 4HX( 1) ) 

DO 60 1 = 1, M 

60 CALL FPL T (PT ( I) ,PX1(I) ) 

CALL EPL T <0 > 

C***PLOT OF MASTER SHOULDER VELOCITY 

CALL SPLT (0 • 0 ,S1 , 4HTIHE, 24HMASTER SHOULDER VELOCITY ,0«,1. ,PX2T, 
1 PX2G, 4H X< 2) ) 

DO 61 1 = 1, M 

61 CALL FPLT(PT<I) ,PX2(I>> 

CALL EPLT(0) 

C*”PLOT OF MASTER ELBOW POSITION 

CALL SPL T <0 • 0 , S 1 , 4H TI ME, 2 1HMASTER ELBOW POSITION , 0 ., 1 ., PX3T, 

1 PX3G, 4HX( 3) ) 

DO 62 1=1, M 

62 CALL FPLT (PT (I) ,PX3 (I) ) 

CALL EPL T (0 ) 

C***PLOT OF MASTER ELBOW VELOCITY 

CALL SPLT (0. 0, SI, 4H TIME, 2 1H MASTER ELBOW VELOCITY, C . ,1. , PX4T, 

1 PX4G, 4H X ( 4) ) 

DO 63 1=1, M 

63 CALL FPL T(Pni) ,PX4(I) ) 

CALL EPLT(0) 

0***p L OT OF SLAVE SHOULDER POSITION 

CALL SPLT (0.C,S1, 4HTIME, 23HSLAVE SHOULDER POSITION, 0. ,1 ., PX5T, 

1 PX5G, 4H X ( 5) ) 

DO 64 1=1, M 

64 CALL FPL T (PT (I) ,PX5 (I) ) 
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CALL EPLT(O) 

C***PLOT OF SLAVE SHOULDER VELOCITY 

CALL SPLT (0»0»Si»4H TIME, 2 3H SLAVE SHOULOER VELOCIT Y , 0 . ,1 . , PX6T , 
1 PX6G,4HX(6)> 

DO 65 1=1, M 

65 CALL FPLTCPT(I) ,PX6(I) > 

CALL EPLT(O) 

C***PLOT OF SLAVE ELBOW POSITION 

CALL SPLT (0.0, SI, 4H TI ME, 2 OHSLA VE ELBOW POSIT ION, 0 ., 1 . ,PX7T , 

1 PX7G, 4H X ( 7) ) 

DO 66 1=1, M 

66 CALL FPL T (PT ( I) ,PX7 (I) ) 

CALL EPLT(O) 

C***PLOT OF SLAVE ELBOW VELOCITY 

CALL SPLT (Q»0»S1»4HTIME,20HSLAVE ELBOW VELOCITY, 0* , 1. »PX8 T , 

1 PX8G, 4HX( 8) ) 

DO 67 1=1, M 

67 CALL FPL T(PT(I» ,PX8 (I) ) 

CALL EPLT(O) 

C***PLOT OF MASTER X TIP POSITION 

CALL SPLT (Q»C»Si,4HTIME,21HMASTER X TIP POSITION , 0 1 ., PXC1T , 

1 PXC 1G , 5HXC ( 1 ) ) 

00 68 1 = 1, M 

68 CALL FPL T (PT ( I) ,PXC 1 ( I ) ) 

CALL EPLT(O) 

C»»*PLOT OF MASTER X TIP VELOCITY 

CALL SPLT (0*C,S1,4HTIME,21HMASTER X TIP VELOCITY , C ., 1 ., P XCD1T , 
1 PXCD1G, 6HXCD (1) ) 

DO 69 1=1, M 

69 CALL FPL T (PT ( I) ,PXC01 (I) ) 

CALL EPLT(O) 

C***PLOT OF MASTER Y TIP POSITION 

CALL SPLT (0»0,S1,4HTIM£,21HMASTER Y TIP POSITION, 0 ., 1 ., PXC2T , 

1 PXC2G , 5HXC ( 2) ) 

DO 70 1=1, M 

70 CALL FPLTCPTCI) ,PXC2(I) > 

CALL EPLT(O) 

C ***pl 0 T OF MASTER Y TIP VELOCITY 

CALL SPLT CO • 0 ,S1 , 4HTI ME, 2 1HMASTER Y TIP VELOCITY , 0 ., 1 ., PXCD2T , 
1 PXCD2G, 6H XCD (2) ) 

DO 71 1=1, M 

71 CALL FPLTCPTCI) ,PXCD2(I)) 

CALL EPLT(O) 

C***PLOT OF SLAVE X TIP POSITION 

CALL SPLT (0. 0, SI, 4H TI ME, 2 OHSL A VE X TIP POSITION, 0 ,, 1. ,PXM1T, 

1 PXM1G ,5HXM( 1) > 

DO 72 1=1, M 

72 CALL FPLT(PTCI) ,PXM1(I)) 

CALL EPLT(O) 

C***PLOT OF SLAVE X TIP VELOCITY 

CALL SPLT (0»0, Si, 4H TIME, 20H SLAVE X TIP VELOCITY, 0 ., 1. ,PXMD1T, 

1 PXMD1G,6HXMD (1) ) 

DO 73 1=1, M 
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73 CALL FPLT(PT(I) ,PXMD1 <I)> 

CALL EPLT(O) 

C***PLOT OF SLAVE Y TIP POSITION 

CALL SPLT (0.0, Si, 4H TI ME , 2 CHSL A V£ Y TIP POSIT ION, 0 ., 1. ,PXM2T, 

1 PXM2G ,5HX M ( 2 ) ) 

DO 74 1 = 1, H 

74 CALL FPLT(PT<I) ,PXM2<I) ) 

CALL EPLT(O) 

C***PLOT OF SLAVE Y T IP VELOCITY 

CALL SPL T(0.C,S1, 4H TI ME, 2 CHSLAVE Y TIP VELOCITY, 0 ., 1. ,PXM02T, 

1 PXMD2G, 6HXMD (2) ) 

DO 75 1=1, M 

75 CALL FPLT(PTCI) ,PXHD2 (I) ) 

CALL EPLT(O) 

C***PLOT OF MASTER SHOULDER TORQUE 

CALL SPLT (0.0 ,S 1 , 4HTI ME, 22HMASTER SHOULDER TORQJE , 0 . ,1. , PTQ1T , 
1 PTQ1G,5HTQ( 1) ) 

DO 76 1 = 1, M 

76 CALL FPL T (PT (I) ,PTQ1(I)) 

CALL EPLT<0) 

C***PLOT OF MASTER ELBOW TORQUE 

CALL SPL T (0. 0 ,Si, 4H TIME, 19HMASTER ELBOW TORQUE, 0 ., 1 . ,PTQ2T , 

1 PTQ2G , 5 HTQ ( 2 ) ) 

DO 77 1 = 1, M 

77 CALL FPL T (PT ( I) ,P TQ2 < I ) ) 

CALL EPLT(O) 

C***pl OT OF SLAVE SHOULDER TORQUE 

CALL SPLT (0 » 0 ,S1 , 4H TI ME,21HSL A VE SHOULOER TORQUE , 0 . ,1 ., PTQ3T , 

1 PTQ3G ,5 HTQ { 3 ) ) 

DO 78 1 = 1, M 

78 CALL FPLTtPni) ,PTQ3(I)) 

CALL EPLT(O) 

C***PLOT OF SLAVE EL80W TORQUE 

CALL SPLT (0.C,S1, 4HTI ME, 1 8HSLAVE ELBOW TORQUE, 0. , 1. ,PTQ4T , 

1 PTQ4G ,5HT Q( 4) ) 

DO 79 1=1, M 

79 CALL FPL T (PT Cl) ,PTQ4 ( I ) ) 

CALL EPLT(O) 

GO TO 99 

90 WRITE (6,91) 

91 FORMAT (5X,*S0L UTION NOT ATTAINABLE FROM DFEQKM* ) 

99 STOP 

END 


SUBROUTINE OFEQK M< NEQ ,X , ST EP » Y , F ,E p S , A B , NCU TS , E X I T , S TP S Z ) 


* SUBROUTINE DFEQKM * 
♦♦♦»»*♦»»»*»*»*****»*♦**»** 


D- 10 



INTEGER NEQ, NCUTS 

REAL X, STEP, Y (NEQ) , F, EPS, AB 

EXTERNAL F 

LOGICAL STPSZ 


H6 , H8 , 
FO (30) , 


ERR, TEST, T, H , EPSL, 
FI (3 0) , F 2 ( 3 0 ) » TEMP 


50 

60 


C *** 

10 
C *** 

C *** 

15 


IS NOW *,G12.4, * 
BEEN HALVED *, 15 


AT T = * » G 1 2 • 4 ) 
* TIMES* ) 


ADJUST HC, IF NECESSARY 


A8S(HC) > GO TO 15 


C *** 
20 
21 

22 


23 

24 

25 


26 
C *** 


REAL FINAL, H2 , H3, 

Y1 (30) , Y 2 (30 ) , 

INTEGER I , CUT 
LOGICAL DBL 

FORMAT (* * » *THE STEPSIZE 
FORMAK* THE STEPSIZE HAS 
HC=0 » 0 
E XI 1=1. 0 

CHECK FOR INITIAL ENTRY ANO 
IF(NEQ.NE.O) GO TO 10 
HC = STEP 
RETURN 

IF(STEP.EQ. 0) RETURN 
IF ( HC .ECU 0 ) HC = STEP 
SET LOCAL VARIABLES. 

FINAL = X+STEP 
H = STEP 
EPSL = EPS 

CHANGE DIRECTION, IF REQUIRED. 

IF (EPS. EQ • 0 .OR. A 9S ( H) .LE. 

IF ( H*HC. LE.O ) HC = -HC 
H = HC 
T = X+H 
CUT = NCUTS 
X = FINAL 
H2 = H/2. 

H3 = H/3 • 

H6 = H/6. 

H8 = H/8. 

MAIN KUTTA-MERSON STEP 

IF (H . GT * 0 .AND. T.GT. FINAL .OR. H ,L T . 0 . A ND. T . L T . F IN AL ) 
CALL F (T-H, Y, F0) 

DO 22 I = 1, NEQ 

Y 1 ( I) = F0 ( I) *H3+Y ( I) 

CALL F(T-2.*H3, Yl, FI) 

DO 23 I = 1, NEQ 

Y 1 { I ) = (F0 (I) +F1 (I) ) *H6+Y (I) 

CALL F(T-2.*H3, Yl, FI) 

DO 24 I = 1, NEQ 

Yl ( I) = (F1(I)*3.+F0(I) )*H8+Y(I) 

CALL F (T-H2 , Yl, F2) 

DO 25 I = 1, NEQ 

Y 1 ( I) = (F2(I)*4.-F1(I) *3»+FQ(I))*H2 +Y(I) 
CALL F (T , Yl , FI) 

OO 26 I = 1 , NEQ 

Y2( I) = (F2 (I)*4. + F1(I) +F0 (I) )*H6 +Y( I) 

DOES THE STEP SIZE H NEED TO BE CHANG EO. 


GOTO 40 
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IF ( EPSL • F.Q. 0) GO TO 38 
D3L = .TRUE. 

00 35 I = 1 f NEQ 

ERR = A 8S (Y 1(1) -Y2 (II ) * 0. 2 
TEST = A BS ( Y1 Cl) > * E PS L 

I F< ERR. LE. TEST .OR. ERR.LT.AB) GO TO 34 
C *** HALVE THE STEP SIZE. 

H = H2 
T = T-H2 

IF ( . NOT . STPSZ ) GO TO 30 
TEMP = T-H2 
WRITE (6,50) H, TEMP 
30 CUT = CUT - 1 

IF (CUT . GE. 0) GO TO 31 
X = T - H2 
WRITE (6,60) NCUTS 

EXIT=0 . 0 


RETURN 

31 


IF ( T +H.NE • T ) GO TO 33 
X = T 


EXIT = 0.0 
RETURN 

C*»* STEP SIZE TOO SMALL RELATIVE TO T, SET EXIT=G AND RETURN 

33 H2 = H/2. 

H3 = H/3 • 

H6= H/6. 

H8 = H/8 . 

GO TO 21 

34 IF (64 .C*ERR.GT .TEST) D0L = .FALSE. 

35 CONTINUE 

C *** DOUBLE THE STEP SIZE, MAYBE. 

IF ( • NO T. 08L) GO TO 38 
H2 = H 
s 2 * ^ H 

IF (STPSZ) WRITE (6,50) H , T 

H3 = H/3. 

H6 = H/6. 

H8 = H/8. 

CUT = NCUTS 


38 

OO 

39 I = 1 

»N 

EQ 

39 


Y( I) = 

Y 

2(1) 


T = 

T +H 




GO 

TO 20 



40 

IF ( 

EPSL.EQ. 

0) 

RETURN 

** 

NOW BE 

SURE TO 

HA 

V E T = FINAL. 


HC = H 

H s FINAL -IT- HI 

IF(ABS(H> .LE.ABS(FINAL) *9.536744 E-7) RETURN 
T= FINAL 
EPSL = 0 
H2 = H/2. 

H3 = H/3. 

H6 = H/6. 
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H8 = H/8. 

GO TO 20 

ENO 

C *** LAST CARD OF SUBROUTINE OFEQ1 


SUBROUTINE FI RO ER ( T , X , OX ) 

C 

C 

C* 4 * SUBROUTINE FOR FINDING FIRST DERIVATIVES 
C 

DIMENSION CV<2) ,MV(2) ,TC(2,2),TM(2,2> ,J1(2,2),J2<2,2) ,TCI(2,2), 

1 TMI (2 ,2) ,R1 (2) ,R2 (2) ,R4(2> ,R6(2) ,PE1(2) ,*E2 (2) ,R3(2) , 

2 R8(2) ,R14 (2) ,R16(2> ,R30 (2) ,R5(2) ,R10(2) ,R7(2) ,R12(2) , 

3 CF < 2) ,MF(2) ,R9(2) ,Rli(2),R18(2> ,R2 0<2> ,R2 2<2) ,TA<2) , 

4 TB(2) ,TI(4) ,TR(4) ,X<8) ,OX (8) ,XC(2) ,XM<2) , XCO(2) ,XMO(2) 
C0MM0N/8LK1/KF3 (4) , KEI (4) ,K1(2,2),><2(2,2),K3(2,2),K4(2,2),K5(2,2), 

1 K6(2,2) ,MM(2,2) ,PI(2) ,RR(2> ,CT(2,2),CTI (2,2) ,GS<4), 

2 CA(2,2) ,MA(2,2) ,FC(2) ,FM(2) , OTC , DTM, LC , LM ,KFL (4) , 

3 RL ( 4) , T L ( 4 ) , T Q ( 4 > 

REAL MV , J1,J2 ,MF, KF B, K El , K1 , K2 , K3 ,K 4, K5 , K6, M M , MA , L C , L M, KFL 
C 

C***EFFECTS OF SERVO RATE LIMITS 

IF (ABS ( X (2 ) ) .GT.RL (1) ) 50,51 

50 X (2) =SIGN(RL Cl) , X €2 ) > 

51 IF (ABS (X(4)) .GT.RL (2) ) 52,53 

52 X (4) =SI GN (RL (2) ,X (4) ) 

53 IF (ABS (X (6) ) • GT «RL( 3) ) 54,55 

54 X(5)=SIGN(RL(3) ,X (6) ) 

55 IF (ABS (X (8) ) ,GT. RL (4) ) 56,57 

56 X ( 8) =SI GN (RL (4) ,X (8) ) 

C***D£FINING JOINT VELOCITIES 

57 CV(1)=X (2) 

C V ( 2) =X ( 4) 

MV(1)=X (6) 

MV (2) =X (8) 

C 

C***CALCULATION OF CID ANO MANIPULATOR TIP POSITION 
C 

XC(l)=LC*COS(X(l) )+LC*COS (X (1) +X(3) ) 

XC(2)=LC ¥ SIN(X(1) )+LC*SIN(X(l)+X(3) ) 

XM(1)-LM*C0S(X(5> >+LM*COS (X (5) +X(7) ) 

XM(2) =LM*SIN(X( 5) > + LM*SIN (X ( 5) +X (7) ) 

C***CALCULATION OF TORQUE MATRICES 

TC(1,1)=-LC*ISIN(X(1) )+SIN(X(l)+X(3)) ) 

TC (1 ,2) = LC* (COS (X (1) ) +COS (X (1) + X ( 3) ) ) 

TC(2,i) =-LCMSIN(X(i> +X C 31 ) ) 

TC(2,2) =LC* (COS (X (1)+X (3) ) ) 

TM(l,l)=-LM* f (SIN(X(5) ) +SIN( X (5) +X (7 ) > ) 

TM ( 1 , 2) -L M* (COS (X (5) ) +COS (X (5) + X (7) ) ) 

TM( 2,1) = -LMMSIN(X(5) +X(7)) ) 
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TM(2,2) = L M* (COS (X(5)+X(7) )) 

C***CALCULATIQN OF JACOBIAN MATRICES 

J1(1,1)=LCM-SIN(X(1) ) -SIN(X (1) +X (3)) ) 

J 1 ( 1 , 2) =LC* (“SIN ( X( 1) (■ X ( 3 ) ) ) 

Jl(2,i) = LC* (COS (X (l))+COS(X(l)+X(3) )) 

J1(2,2)=LCMC0S (X (1)+X (3) ) ) 

J2(1»1)=LM* ( -SI N ( X ( 5) ) -SIN(X(5)+X (7)) ) 

J2 ( 1 » 2) = L M* ( -SIN ( X ( 5) + X(7) ) ) 

J2(2,l) = LM* (COS (X (5)) +COS (X ( 5) +X < 7) )) 

J2(2,2) =IM* (COS (X (5) + X (7) ) > 

C»*»CALCULATION OF INTERNAL VECTORS IN SIGNAL CHANNELING LOOP 
DO 100 1=1,2 

100 Rl(I) =XC (I) -Pl( I) 

CALL MM PRDU ( CT , XM ,R2 , 2 ,2,1) 

DO 101 1=1,2 

101 R4(I)=R2(I)*MM(I,I) 

DO 102 1=1,2 

102 R6( I) =R4 (I) -RR( I) 

DO 103 1=1,2 

103 PEI < I ) =R6 (I » -R1 (I ) 

OO 104 1=1,2 

104 PE2 ( I ) =R1 (I ) -R6 (I > 

DO 105 1=1,2 

105 R3(I)=P£i(I)*Ki(I,I) 

DO 106 1=1,2 

106 R8(I)=PE2(I) ¥ K4(I,I) 

CALL MMPRDU ( J1 , CV ,X CD , 2 , 2,1) 

CALL MMPRDU(J2,MV ,XMD ,2,2,1) 

CALL MMPRDU (CT , XMD, R14 ,2, 2, 1) 

DO 107 1=1,2 

107 R 16 ( I ) = R 1 4 ( I ) * M M ( I , I ) 

DO 108 1=1,2 

108 R30 (I)=XCD(I) -R16 CD 
DO 109 1=1,2 

109 R5( I ) =R3 0 (I ) *K3 (I , I ) 

DO 110 1=1,2 

110 R10 ( I) = R30 ( I) 6 ( I, I) 

DO 111 1=1,2 

111 R7(I)=XCD(I)*K2 (1,1) 

DO 112 1=1,2 

112 R12 ( I) =R16( I) *K5 C I, I) 

DO 113 1=1,2 

113 CF (I ) =R3 ( I) -R5< I) +R7 ( I ) 

DO 114 1=1,2 

114 MF ( I ) =R8 ( I) +R10 (I ) + R1 2 ( I > 

CALL MMPRDU (TC,CF ,R9, 2,2,1) 

DO 115 1 = 1,2 

115 Rli (II = R9 (I) *CA.(I,I) 

CALL MM PRDU ( CTI , MF ,R18,2,2,1) 

CALL MMPRDU (TM,R18, R20 ,2,2,1) 

DO 116 1=1,2 

116 R22 (I) =R2Q(I) *MA( I, I) 

C**»CALCULATION OF INPUT TORQUES FROM INPUT FORCES 
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CALL MMPRDU(TC,FC ,TA, 2,2,1) 

CALL MMPRDUCTM,FM,TB,2,2,1) 

TQ(1) = CR11(1) -KFB (1) * X (21 l*KFL(l) 
TQ(2)=CRli(2) -KF3(2)*X(4> )*KFL (2) 
TO ( 3) = t R22( 1) -KFB (3>*X (6) >*KFL (3) 
TQ<4)=<R22(2>-KF3(4>*X(8> )*KFL(4) 
C***EFFECTS OF SERVO TORQUE LIMITS 
DO 71 1=1,4 

IF (ABStTQM) >.GT.TL(I>> 70,71 

70 TQ(I)=SIGN(TL(I)»TQ<I)) 

71 CONTINUE 

00 72 1=1,2 

72 TI(I)=TQ(I)+TA(I) 

DO 73 1=1,2 

73 Tl (1 + 2) =TQ( 1 + 2) +TB( I) 

C ***NO GEAR SUCTION INCLUDED 
DO 74 1 = 1,4 

74 TR(I)=TI(I) 

C***DE TERMINATION OF FIRST DERIVATIVES 
125 DX C 1) =X C 2) 

DX(2)=KEI(1)*TR<1> 

DX(3)=X (4) 

DX(4)=KEI<2)*TR(2> 

DX(5)=X (6) 

DX(6)=KEI(3)*TR<3) 

DX ( 7 ) =X ( 8) 

DX( 8) =KEI (4) *TR(4) 

RETURN 

END 

C***ENO OF SUBROUTINE FIRDER 


SUBROUTINE MINMAX ( M , X I » X M IN , X M A X ) 

0*** SUBROUTINE FOR FINDING MIN. AND MAX. VALUES OF VECTORS 
DIMENSION XI ( 1020 ) 

XMIN=XI ( 1) 

XMAX=XI (1) 

DO 1 1=2, M 

IF ( XMIN • GT. XI ( I ) ) X MI N = X I (I) 

1 IF (XMAX.LT.XI (I)) XMAX=XI (I) 

RETURN 

END 

C***LAST CARD OF SUBROUTINE MINMAX 


SUBROUTINE SCAL E( XPMAX ,XPMIN, NSQ,XSMAX, XSMIN,S) 
XPMAX=MAXIMUM VALUE TO BE PLOTTED 
XPMIN= MINIMUM VALUE TO BE PLOTTED 
NSQ =NUMBER OF PLOT MAJOR GRIDS = 10 
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XSMAX=MAXIMUM SCALE VALUE 
XSMI N=M I N IMUM SCALE VALUE 
S -SCALE FACTOR PER MAJOR GRID 
FNSQ=NSQ 
X SMI N = 0.0 

IF(XPMAX-XPMIM) 12,12, 13 

12 XPMIN=XPMIN-5.0 
XPMAX=XPMAX+5.0 

13 XDIF = XPM AX- XP MI N 
DO 1 1=1,66 

DO 1 J=1 ,3 

T=2,0** ( J-2) *FNSQ/10. 0 
IF(XDIF-T*10. 0**033) >2,2,1 

1 CONTINUE 

2 S=T+1Q. Q**(I-33)/FNSQ 
IF(XPMIN) 3,7,4 

3 XSMI N=XSMIN-S 

IF ( XSMI N-XP MIN) 7, 7, 3 

4 XSMIN=XSMIN+S 
IF(XSMIN-XPMIN) 4, 7,6 

6 XSMIN=XSMIN-S 

7 XSMAX=XSMIN+ S*FNSQ 

IF (XSMAX-XPMAX) 8, 11,11 

8 IF(J-3> 10,9,9 

9 J = 0 

1 = 1 + 1 

10 J=J+1 

T=2. 0** (J-2) +FNSQ/1 C • 0 
XSMIN=0 • 0 
GO TO 2 

11 XSMIN=XSMAX-10. G*S 
RETURN 

END 
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APPENDIX E - MANIPULATOR TRAJECTORY DATA 


A digital computer program was written to calculate the 
manipulator position and attitude from the joint angle data 
recorded during the manipulator trajectory definition task. 

The analog data defining the joint angles were transcribed into 
digital format for use as input data to the program. The 
following pages list the results obtained with this program. The 
X, Y, Z information defines the position of the wrist of the 
manipulator relative to the shoulder joint, in the Shuttle axis 
system. Likewise, the Roll, Pitch, Yaw information defines 
the attitude of the terminal device relative to the Shuttle, 
for a standard Yaw-Pitch-Roll Euler angle sequence. The corres- 
ponding manipulator joint angles are then listed, along with 
comments describing the position of the manipulator at signi- 
ficant points along the trajectory manipulator shoulder loca- 
tion, in relation to the shuttle, is shown in Figure 11-5. 
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APPENDIX F - MECHANICAL DESIGN OF MASTER AND SLAVE OF 2 DOF BREADBOARD 


Two simple, breadboard- type test mechanism arms were de- 
signed to provide a tool for proving the control equations of 
a six degree-of-freedom, bilateral, force-reflecting tele- 
operator/manipulator system. The requirements were stipulated 
by the control system engineers as a minimum for proving the 
feasibility of the concept. 

The master arm has two 11-in. segments and the slave, two 
22-in. segments. All joints are similar. Design details are 
shown in Figure III-21, and the final product is depicted in 
Figure III -5. 

Normally the devices will be mounted with the arm plates 
parallel to the floor or ground. The arms are not designed 
to take any additional vertical tip load, only the weight of 
the arm itself. In the horizontal plane, a tip force of up 
to about 8 lb can be developed on the short (master) arm 
and about 7 lbs on the large (slave) arm when both arms are 
in the fully extended position, neglecting small friction 
losses. These forces will be sufficient to demonstrate the 
bilateral servo control system. The joints themselves were 
designed using 100:1 or less simple spur gearing to assure 
a backdriving capability. No brake system or limit stops were 
provided. 


Many motors and generators were investigated. It was con- 
cluded that a self-contained, packaged motor and generator unit 
available from Inland Motor Company would be the least expen- 
sive, yet provide suitable torque and speed characteristics 
for use with the servo control electronics. The selected motors 
have a torque rating of 54 in-oz at stall. 


The gears have been designed to accommodate 307 o greater 
loads than the motor stall torque, but they will not take 
severe impact loads. 

Inertias of the joint members and outer arm have been cal- 
culated and frictional characteristics were also investigated. 

The maximum backdriving torque at any joint has been cal- 
culated to be between 1.5 and 2.2 ft-lb based on a motor 
starting frictional torque of 3. 3 in-oz. The dynamic friction 
should be less than half of this. 


F-l 




Figure III-21 Schematic of Two Degree of Freedom Breadboard Arms 





1. Requirements 


A list of requirements for mechanically designing the 
breadboard arms and joints is presented below. Some of the 
items were generated at the outset of the program; others 
evolved as the design progressed, 

1. The design shall include two simple breadboard man- 
ipulator arms, one master and one slave, each of 
which is electrically driven. 

2. The master shall be capable of controlling the slave’s 
tip position within + 1/16 in. , excluding gear back- 
lash effects. This is equivalent to an accuracy 

of approximately 10 minutes of arc and relates pri- 
marily to the selection of position potentiometers 
and control electronics. 

3. To obtain size disparity, the slave arm shall be at 
least twice as long as the master arm. 

4. Arms shall operate only in the horizontal plane (no 
motion against gravity). 

5. No terminal device is required. 

6. Torques at joints shall be at least 25 ft-lb. 

7. The master arm shall be capable of exerting a tip 
force of at least 8 lb. 

8. When no load is applied, the shaft speed at the rated 
output capability of the gear train shall be 1,5 
rad/ sec. 

9. Backlash should be kept to a minimum. 

2. Design Summary 

a. Components : 

Motor : Inland Motor Company Model NT2173; operating 

voltage = 22.8 V, - Integrally packaged. 

Tach. Generator : Inland Motor Company Model TG0714 
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Potentiometers : Slave- 20 turn, infinite resolution; 

Master 20 turn^ inf inite resolution 

Gears : Straight spur gears 

Gear Ratio : 

Master Shoulder - 62:1 
Master Elbow - 29:1 
Slave Shoulder - 100:1 
Slave Elbow - 100:1 

Gear Meshes : Output gears: , Pitch = 20, pressure 

angle = 20°, Ratio - 5,56:1 

Intermediate gears: Pitch = 32, 

pressure angle = 20°, Ratio - 5.33:1 

Input (motor) gears: Pitch = 48, 

pressure angle = 20°, Ratio = 3.42:1 

Bearings : Flanged ball bearings 

Double shield 

Arm Plates : 6061 T-6 aluminum alloy, 1/4 in. thick. 

Standoffs : 2-in. -long x 0.50-in. x 0,50-in. aluminum 

alloy 

Mounting : Optional - Clamped or bolted to table or wall 

Design Data 

Inertias : Look-in or backdrive inertia of gear train 

joint = 7,08 in. -lb sec^ 

Torques/ Forces : Maximum stall torque = 28 ft- lb 

Calculated Data : Full load condition (not including 

motor stiction) 

* 

Static Efficiency : Backdrive = 92.8% 

Forward drive = 98. 0%, 

Dynamic Efficiency ; Backdrive = 95.6%, 

Forward drive = 98.5% 

Backlash: 3.7 minutes of arc, calculated 



Estimated Backdriving Torque ; 

Static: 1, 7 to 2. 2 ft-lb with motor 

Dynamic; 0,5 - 1.0 ft-lb with motor 

4, Test Data (Using Torque Watches) 

Actual Backdriving Torque : 

Static: Approximately 10 to 11 in. oz without 

motor; 315-350 in oz with motor and tach gen. 

Drive Shaft (Less Motor) : 

Static: Approximately 0. 1 in. oz breakaway 

Backlash : (See Page III- 104) 

5, Design Approach 

a. Design Philosophy - The basic approach was to develop 
a simple design with standard components. In our design, 
both the master and slave arms use similar joints. The gears 
are housed between two flat plates whose bearing holes were 
simultaneously line-reamed to ensure parallel mounting of the 
shafts. These plates were used not only to support the gear 
train, but also to act as arm segments and provide structural 
support. Both the master and slave arms were built so that 
they can accept extra degrees of freedom if the necessity 
arises during the later stages of the control study. A dis- 
advantage of the system is that the connecting plates produce 
a high arm inertia. 

b. Accessibility and/or Interchangeability - Should the 
requirement arise, the gears can easily be exchanged to achieve 
a joint gear ratio higher or lower than the present 100:1. 

The joints are not encased and the gears can easily be cleaned 
if necessary. 

c. Lubrication - We anticipate that the gear teeth and 
ball bearings may require periodic light lubrication. 

1. Bearings are to be greased with MIL-G3278 

2. Gears are to be lubricated with MIL-L6085A or 
an equivalent light oil. 
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Name 

No. 

Pitch 

Diameter, 

in. 

Outside 
Diame ter, 
in. 

Face 

Width, 

in. 

Gear 

Material 

Ratio 

Gear 

i 

5.000 

5.100 

0.375 

CRS* 

5.560 

Pinion 

2 

0.900 

1.000 

0.375 

CRS 

Gear 

3 

3.000 

3.062 

0.375 

Bronze 

5.333 

Pinion 

4 

0.5625 

0.625 

0.187 

CRS 

Gear 

5 

2.000 

2.042 

0.187 

Aluminum 

3.452 

Pinion 

6 

0.5833 

0.625 

0.187 

CRS 


* Corrosion-resistant steel 







*E.E. Shipley: 
Journal 


Theoretical Forward Drive Efficiency 

K = !t / m) 

FD ' M ' 


N 


V = 0.2618 DN 
H 


= ( 2±1 ) jjll - cos 2 e' - sin e) 

t =( N+l j - cos 2 Q 1 - sin 9 J 

2 2 
H + H . 

( a 2- fH^) 


cos 0 
E = 100 - P 
where 

K = load factor 

W fc = tangential tooth load, lbs 
N = gear ratio of mesh 
n = pinion speed 
F = face width of gear, in. 

D = diameter of gear, in. 

V,= pitch line velocity, ft/minute 

H = sliding velocity to pitch line velocity ratio (start to 
s approach) 

H = sliding velocity to pitch line velocity ratio (recess 
action) 

r = radius of pinion, in. 
o 

r = pitch radius of pinion, in. 

@ = pressure angle of gear (20° for all joints) 

R q = Radius of gear, in. 

R = pitch radius of gear, in. 
f = coefficient of friction 
P = power loss, % 

E = efficiency, % 

"How to Predict Efficiency of Gear Trains." Product Engineering 
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Figure III-22 Gearing Characteristics of Two DOF Breadboard Arms 




e . Forward Drive Dynamic Efficiency 


Mesh 1,2 : = 11.2 ft/ minute; using Shipley's chart, 

^ated " 600 > f = °* 053 

H = 0.151) 

S f 

H _ o 496) At maximum rated load & speed 

P - 0.496 
E = 99.50% 

Mesh 3,4 : K = 583, V = 37 f = 0.051 

H = 0.162 
s 

H fc = 0.1835 
P « 0.47% 

E = 99.53% 

Mesh 5,6 : K =173, V = 134 f = 0.043 

H = 0.1371 
t 

H = 0.123 
s 

P = 0.298% 

E = 99.7% 

Overall dynamic efficiency at full-load (rated) condition = 98.5% 

f. Forward Drive Efficiency at Startup (slow speed) considering 
higher friction factors: 

Mesh 1,2 = 99.25% 

Mesh 3,4 = 99.25% 

Mesh 5,6 = 99.60% 

Overall static efficiency = 98% 

g. Backdrive Efficiency (At a rated load of 28 ft-lb and an angular 
velocity of 0.90 rad/sec for dynamic consideration) 
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Mesh 1,2 : K = 80, V = 0, f = 0.070, (f includes 

additive of 0.025) 

H = 0.0354 
s 

H fc = 0.890 
P = 3. 177o 
E = 96.83% 


Mesh 3,4 : 

E = 96.97% 

Mesh 5,6 : f = 0.060 

P L = 1.245% 

E = 98.75% 


Overall static efficiency of gear train = 92.8% 

h. Backdrive Dynamic Efficiency 
Mesh 1,2 = 98.76% 

Mesh 3,4 = 97.0% 

Mesh 5,6 = 96.8% 

Overall dynamic efficiency = 95.67, 

i. Projected Backlash Calculations 



AC 


AC ] 

AC, 


AC, 


ic friction 


Center Distance 
Change (Bending 
+ Tolerances) 

0.003 in. 

0.002 in. 

0.002 in. 
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Consider rated load: 
Mesh 1 B L = 

Mesh 2 B 2 = 

Mesh 3 B 3 = 


0.728 

2.5 

0.728 

1.5 


0.728 

1.0 


x 0.003 x 3438 - 
x 0.002 x 3438 = 
x 0.002 x 3438 = 


Backlash of power gear: 

*1-3 = 2 * 9 ° + 


3.57 

5.56 


2.37 
5.56 x 


= 3 minutes 40 seconds. 


2.90 

3.57 

2.37 


5.33 
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6. Calculated Inertias (Summar 


The inertia calculations included herein do not include all members. 


Connecting 

Plates 



° ut er A 


-4 2 

1^ (Power Shaft) = 170.5 x 10 in-lb-sec (arm not included) 

/ o 

(Gears 2 & 3 + Shaft) = 24.75 x 10 in-lb-sec 

1^ (Gear 4 & 5 + Shaft 4) = 0.80 x 10 ^ in-lb-sec^ 

-4 2 

1^ (Motor Rotor + Shaft) = 6.92 x 1C in-lb-sec 

To obtain I (^look-in" inertia) we multiply by the square of the gear 
ratio; 

I ("look-in-" inertia) - j 170.5 + 24.7 (5.56) 2 + 0.8 (5.56 x 5.33) 2 


+6.9 (100) 2 } x lO -4 - 7.08 in lb sec' 


I (Outer Arm Segment) = 0.95 in-lb-sec (about power shaft) (slave) 
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Figure III-23 Weight Summary of Two DOF Breadboard Arms 




EFFICIENCY 



TIME 

Figure III-25 Forward and Backdrive Characteristics of Breadboard Arm Joint 
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8. Air Bearing Inertia Load 


An inertia load of approximately 300 lbs as free from 
friction as possible was required to simulate payloads on the 
end of the 2 DOF Breadboard manipulator arm. It was desired 
to employ this load for horizontal use on the same table 
area that the 2 DOF system was installed. 

Ball bearings, air bearings and a suspended counterbalanced 
support system were considered. Ideally, a three air bearing 
system would be desirable however space on the table was 
limited and small air pads are not readily available. It was 
questionable that a single air bearing would give sufficient 
stability, however, a simple test of a proven air pad from 
one of our existing air pad simulators showed that with 
careful air supply regulation the stability was excellent. 

The following design evolved which allowed the mass to 
be used on the existing test table and beneath the arm tip. 



Weld all 4 corners 


Threaded Post 
(Manipulator Drive) 



1/8" Rad. 


Retain flat 
within 1/32" 


Side View Section 
Mat'l: 1/16 Cold Rolled Steel 


Welded Handles (2) 
1/4" Rod 


Air Bearing 


Figure III-26 Pan and Air Bearing Design 


for lead shot) 
1400 in 3 


3 

in x 3.5 in = 1400 in 

Air Bearing Pad 

Effective diameter = 12 in 
2 

Area = 113 in 

Air pressure required = -jyj = -2.6.5 psi 

This is easily supplied and regulated from shop air. Travel 
capability on the Masonite covered table is approximately + 18 in, 
in X and Y axes. 


Weight (Lead Shot) 

= .215 lb/ in^ (density 

. , 300 lb 

Required 1 = 


in ^ 

Pan Volume = 20 in x 20 
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